Function: control_engine_f ol lower 



* Description: 

* This function sots the override_controljnode to no over ride so that 

* the engine follows the accelerator demand. 

♦♦♦****************####**^*******#**************##*#**#*****#*********** y 

static void control engine follower(void) 
< 

ttefine POSITIVE PEDAL TRANSITION TIME 25 /* 250 MSEC V 
Jdefine NEGATIVE~PEDAL~TRANSITIOlf TIME 40 /* 400 MSEC V 



engine_status = ENGINE_F0LL0UERJ400E; 

if ((accelerator _pedal _position >■ 5) && /* positive pedal transition */ 
(accelerator _pedal _position old <» 4) && 
(low speed latch « FALSE))" 

C 

positive .pedal trans * TRUE; 

zero flywheel trq_time » POSITIVE PEDAL TRANSITION TIME; 
if (7ero_flywheel_trc^tiiDer >■ NEGAT I VE~PEDAL_TRANS I T ION_T I ME ) 
zero flywheel trq^timer = 0; 

> 

else 
< 

if ((accelerator_pedal .position <* 4) && /* negative pedal transition */ 
(accelerator_pedal ^position old >= 5) && 
(low speed latch « FALSE))" 

i 

zero_flywheel_trq_time * NEGAT I VE_PEDAL_TRANS I T I 0N_T I ME ; 
zero flywheel trq_timer * 0; 

> 

> 

if ((zero_f lywheel.trq_timer < zero_f lywheel_trq_time) && 

(current gear > 1) && (current gear < 10) && (low speed latch « FALSE)) 

{ 

engine control * TORQUE CONTROL; 
comroand.ETCI = C_ETC1_OVERSPEED; 

des i red~eng i ne_pc t_t rq a needed_percent_for_zero_f lywheel_trq; 

if (actual_engine_pct_trq < ( needed _percent_for_zero_f I ywheel_trq ♦ 5)); 
zero flywheel trq_tTmer*+; 

> 

else 

C 

if ((positive j»dal trans « TRUE) && (low speed latch « FALSE)) 
< 

positive j«dal_trana » FALSE; 

engine^commands ■ ENGINE Jul COVEAY; /* engine: finish torque return */ 

control engine recovery <); 

> 

else 
C 

engine control » OVERRIDE DISABLED; 
command ETC1 = C ETC1 NORMAL; 

> 

> 

/* if predipjnode had been forced, this is the place to clear its flag. V 
/* But only clear it if the pedal is depressed. This is for the case when V 
/* a false confirmed gear is seen but the driver actually is coasting down. */ 
if (accelerator_pedal_position > 4) 
forced^predip » FALSE; 

> 

ipragma EJECT 



* Function: control_engine_idl« 

* ~" 

* Description: 

* This fmction sets the engine controls for the idle mode. 
* 

*******+************«********«********************************** 

static void control engine idle(void) 
C 

engine control * OVERRIDE DISABLED; 
coamand_ETC1 « C_E TCI .NORMAL; 

engine.statMS * ENGINE IDLE HODE; 

> «~ 

fpragma EJECT 



* Function: control_eng1ne_atart 

* Description: 

* ThU function sett the engine controls for the start mode. 

***^**#*************************** ********* ****** ******* 

static void control engine start(void) 
C 

engine control « OVERRIDE DISABLED; 
comnand.ETCI ■ C_ETC1 JIORRAl; 

engine status > ENGINE START MODE; 

> 

•pragma EJECT 



* Function: control _eng i ne_coapr es* i on brake 

* "* 

* Description: 

* This function controls the state of the engine compression brake. 

* The brake can be used during upshifts to speed up the decel rate of 

* the input shaft. 
* 

static void control engine compression brake(void) 
( 

if (engine_coninunication_active fti 

(engine'status == ENGINE SYNC MODE) && 
(shift type == UPSHIFT) U 
(input~speed_filtered > (gos ♦ 150)) &* 
(destination_gear > 1) W 
(destination's ear < 7) U 
(engine_brake_avai lable) && 

((dos .predicted < dos_prdtd Lin no jake) || eng brake assist)) 

< 

eng brake assist 3 TRUE; 

> 

else 

i 

eng brake assist = FALSE; 

> 

eng_brake_assist » FALSE; /* debug • force false state for now */ 



fpragma EJECT 



Function: detenaine_goa 



Description: 

This function mulitplies the destination gear ratio tines the 
output shaft speed for use in the DRl_CMDS module. 



90s = (g)ear * (o)utput (s)peed 



static void determine gos(void) 
i 



/*** determine gos for the destination_gear ***/ 
_bx » trn_tbl ,gear_ratio[destination_gear ♦ GR_0FS3; 
_cx « output_speed~f iltered; /* output speed V 
asm mutu cxdx, bx; /* B1M 8 result V 

asm shrl ~cxdx, #8; /* make BIN 0 V 

90s = _cxj /* BIN 0 */ 

_bx = trn_tbl ,gear_ratio[destination_gear + GR_0FS3; 
~cx ■ *(uTnt *)&dos_f iltered; 
asm mul _cxdx, _bx;~ 
asm div _cxdx, #256; 
dgos = *<int *)4_cx; 

gos_signed = {signed intXgos); /* allow signed math in other functions*/ 

/*** determine gos for the "current_gear u ***/ 
_bx 3 trn_tbl .gear_ratio[current_gear ♦ GRJ5FS1; 
~cx = output_speed~f i Itered; "/* output'speed */ 
asm raulu _cxdx, _bx; /* BIN 8 result */ 

asm shrl "cxdx, ?8; /* make BIN 0 */ 

gos_current_gear = _cx; /* BIN 0 */ 



#pragma EJECT 



Fuvtion: dtttmine^shiftabUlty^vari able* 
Description: 

This f tret ion filters both the output speed and the rate of change of 
the output speed for use in the shiftability function. This function 
also calulates the rate of change of the input shaft based on the 
filtered value for the rate of change of the output shaft. 

The filters used in this function are required to get a high level of 
stability. The BIM 8 filter used here will provide a much smoother 
output which is needed to filter out drivel ine oscillations. 

Note: These calculations were placed in this nodule because it is 
called on a regular 10 msec interval. These calculations should 
be placed in the pr_1_s_i.c96 module once shiftability is proven. 
These variables a refused in the SEL GEAR.C96 module. 



it***************************************/ 



static void determine shiftability variables(void) 
i 



/* LPF coefficients: 


exp(-wT), 


T*0.010s 


*/ 




#define OS LPF 


248 


/* 


0.9691 


BIN 8 (0.50Hz) 


*/ 


#define 00SFK1 


249 


/* 


0.9727 


BIN 8 (0.44Hz) 


V 


#define EPTFK1 


252 


/* 


0.9844 


BIN 8 (0.25Hz) 


V 


#define IS FK1 


235 


/* 


0.9219 


BIN 8 (0.??Hz) 


V 


fdefine 0S~FK1 


236 


/* 


0.9219 


BIN 8 (0.??Hz) 


*/ 


#define DISFK1 


236 


/* 


0.9219 


BIN 8 (0.??Hz) 


V 


#define LOU RANGE 


3197 


/* 


3.1224 


BIN 10 


V 


#define BIN~10 


1024 











static long dos_f i ltered_bin8; 
static int ept_f i ltered_bin8; 

unsigned long is_f i ltered_partial_1; 
unsigned long is_f i ltered_partial_2; 
unsigned long os^f i ttered_pertial_1; 
unsigned long os_f i t-tered_partial_2; 

/** create lpf_output_accel **/ 

_bx » *(uint *)&output_speed_accel; 
~cx * *<uint *)4lpf_output_accel - _bx; 
asm mul _cxdx, #OS_LPF; 
asm div j:xdx # #256; 
_bx ♦» _cx; 

Tpf_output_accel = *( int *)&_bx; 



/* bx = x<n), SIN 0 V 

/* cx = y(n-1) - x(n) # BIN 0 */ 

/* cxdx = **(...), BIN 8 */ 

/* make BIN 0 V 

/* _bx * x(n) ♦ K*<...), BIN 0 */ 
/* save acceleration V 



/** dos_filtered = <dos_f i Itered * 0OSFK1) ♦ <lpf_output_accel * (1-0OSFK1) **/ 



_cxdx ■ *(ulong *)&doe_f i ltered_bin8; 

asm shral _cxdx, #2; 

asm mul _cxdx, #D0SFK1; 

asm shral _cxdx, #6; 

dos_f iltered_bin8 =» *<long *)i_cxdx; 

cx * *(uint *)&lpf output accel; 
"bx » 256 - 0OSFK1;" 
asm mul .cxdx, _bx; 
dos_f i ltered_bin8 +« *(long *)*_cxdx; 



/* BIN 8 */ 
/* BIN 6 ( cx) */ 
/* BIN 14 */ 
/* BIN 8 V 
/* save partial result */ 

/* BIN 0 */ 
/* 1 BIN 8 - DOSFK1 */ 
/* 8IN 8*/ 

/* sum is final result V 



dos_filtered » <int)(dos_f i ltered_bin8 » 8); /* BIN 0 */ 

/** eng_percent torque filtered a <eng_percent torque filtered * EPTFK1) ♦ 
(net~engine_pct_trq * (1-EPTFK1) **7 



cx » *(uint *)4ept filtered bin8; 
asm mul _cxdx, #EPTFK1; 
asm shraT _cxdx ( #8; 
ept_f iltered_bin8 = *(int *)4_cx; 

cx ■ net engine _pct trq; 
Jw ■ 256"- EPTFK1; " 
asm mul _cxdx, J»; 
ept.fi I tired J>in8 *<int *)4_cx; 



/* BIN 8 V 
/* BIN 16 V 
/* BIN 8 V 
/* save partial result V 

/* BIN 0 */ 

/* 1 BIN 8 - EPTFK1 V 
/* BIN 8 V 

/* sum is final result V 



#fig_percent_t orqpa.f 1 1 tared » (cfcar)<ept_f UteredJ>in8 » 8); 

/** input_shaft_acctl_calculated ■ dos_f1ltertd * gear.ratlo **/ 

_cx « tm_tbUgear_ratio(dtstination_gear ♦ GR OFS]; /* BIN 8 V 
~bx ■ *(u7nt ^idoa.fU tared; " /* BIM 0 V 

asm mul _cxdx, _bx;~ /* BIN 8 */ 

asm shral _cxdx7 #8; /* Bin 0 */ 

input.shaft.accel.calculated « *(int *)&_cx; 

/*** calculate filtered input and output shaft speeds for AutoSplit ***/ 

/*** determine os_based_on_rcs variable ***/ 

if (output speed <~1000)~ 

< 

bx « aux speed; /* BIN 0 */ 

_cx » 81N~10; /* BIN 10 */ 

_ax » L OUTRANGE; /* BIN 10 */ 

asa mulu _cxdx, _bx; /* make aux.speed BIN 10 */ 

asm divu _cxdx, _ax; /* divide by low range BIN 10 */ 

os based on res = cx; /* BIN 0 */ 

> 

/** input_speed_fi Itered = (input speed filtered * IS FK1) ♦ 
(input_speed * (1-IS_FK1) **/ 



.ax « (is filtered bin8 » 4) 

jcx » IS_FK1 ; 

asm mulu _axbx ( _cx ; 

asm shrl _axbx, #4 ; 

ia.f i ltered_partial_1 = _axbx 

_cx * input.speed ; 

~ax a 256 -~IS_FK1 ; 

asm mulu _axbx, _cx ; 

is.f i ltered.partial.2 = _axbx 



/* BIN 4 
/* BIN 8 
/* BIN 12 
/* BIN 8 
/* 8IN 8 

/* BIN 0 
/* 1 BIN 8 
/* BIN 8 
/• BIN 8 



IS FK1 



is.f i ltered_bin8 * is_f i ltered_partial.1 ♦ is.f i ltered_partial_2 ; 
input_speed_f i Itered = (unsigned int)( is.f i Iter ed_bin8 » 8); /* 8 IN 0 



/** output speed filtered = (output speed filtered * OS FK1) ♦ 
~ (output_speed * (T-0S.FK1) **/ 



ax = (os filtered bin8 » 4) ; 
~cx » 0S.FK1 ; 
asm mulu _axbx, _cx ; 
asm shrl "axbx, #4 ; 
os.f i ltered.partial.1 = _axbx ; 

#if (0) 

if (output.speed < 250) 
_cx » os.based.on.rcs; 
else 
Utendif 

_cx a output_speed ; 

_ax ■ 256 - OS.FK1 ; 

asm mulu _axbx7 _cx ; 

os_f ilte r ed_par t7a I .2 * .axbx ; 



/* BIN 4 
/* BIN 8 
/* BIN 12 
/* BIN 8 
/* BIN 8 



/* BIN 0 



/* BIN 0 



V 
V 
*/ 
V 
V 



/* 1 BIN 8 - OS FK1 V 
/* BIN 8 V 
/* BIN 8 */ 



os_fUtered_bin8 » oa^fi Itered _partial_1 ♦ os.f i ltered.partial.2 ; 
output.speed.filtered » (unsigned intHos.f Htered.binS » 8); /* BIN 0 



/** input_speed.accelji Itered ■ ( i nput.speed.ac eel .fi Itered * DISFK1) ♦ (input.shaft.accel * (1-DISFK1) **/ 



_cxdx • *(ulong *)&dis.f i ltered.bin8; 
asm shral cxdx, #4; 
asm mul _cxdx, «DISFK1; 
asm shraT _cxdx, #4; 
disJUtered^binS * *(long *)4_cxdx; 

_cx ■ *(uint *)4input speed accel; 

.bx » 256 - DISFK1; 

asm mul .cxdx, .bx; 

dfa.fi I tered.binS ♦« *(long *)4.cxdx; 



/• BIN 8 */ 

/* BIN 4 ( cx) */ 

/* BIN 12 V 

/* BIN 8 V 

/* save partial result V 

/* BIN 0 */ 
/* 1 BIN 8 - 0ISFK1 V 

/• BIN 8 V 

/* sum is final result V 



input_speed_accel_filtered « (int)(dt«JUteredJ>infl » e>; /* II* 0 •/ 

/** determine state of clutch *•/ /•**!! 1 1 this (s temporary until we set V 

/*** clutch state over J1939. Ill***/ 

tif <0> 

if (engine_speed > input^speed) 

clutch_sTip_speed « engine^ speed - input _speed; 
else 

clutch - slip_speed » input_speed - engine_speed; 

if (clutch slip speed > 200) 
clutch_state~» DISENGAGED; 
else 

if ((engine speed > 700) && (low speed latch « FALSE)) 
clutch state » ENGAGED; /* Note: 700 should be idle+IOORPtt V 

#endif 

/*** Below is a known undesirable condition that could be corrected with the J 1939 
clutch state information. When input speed is brought below 700 RPM 
while in gear and the clutch is disengaged to acheive gear box neutral this 
algorithm holds the system in the follower mode until the driver bring the 
engine speed above the 700 RPM limit. The 700 RPM limit is needed to prevent 
false ENGAGED indications at idle speeds. ***/ 



/** determine desired percent torque needed for zero torque at flywheel **/ 
#if (.0) 

/* This does not work but was not a problem to hard code a value 
because the accessory loading in this vehicle does not change 
much. This algorithm DOES need to work for the product. */ 
if ((accelerator _pedal_posi tion < 2) && 
(clutch_state == ENGAGED) && 
(current_gear =■ 0) && 
(input speed filtered < 1100) &i 
(((engTne_control « 0VERR I 0E_0 I SA8LED ) && 
(Low_speed_latch =» FALSE) U (current_gear « 0)) || 
(outpxjt_speed_f iltered < 20))) 
percent torque accessories - eng_percent torque filtered; /* get at idle */ 
#endif 

percent_torque_accessories * 3; /* force value for now */ 

needed_percent_for_zero_f lywheel_trq 3 percent_torque_accessories ♦ 

~ nominal_f riction_pct_trq; 

/** determine overall error across the transmission **/ 

overal l_error = ((signed int)( input_speed_f i Itered) - (signed int)(gos)); 



#pragma EJECT 



taction: coanunicsta_with_dri valine 



* Description* 

* This is the periodic task which controls the actions of the engine 

* by defining sods of control and controlling speed and torque output 

* levels depending upon the control function being performed. This task 

* is also intended for control of other drivel ine components (not yet 

* named) which say be available in the future. 

void communicate with drivel ine(void) 

initial ize_drivel ine_data(); 

x start_periodic(); 

while (1) 

€ 

cont r o l_eng i ne_compr ess i on_br ake( ) ; 

determine_gos(); /* calculate (G)ear tiroes the (Output (S)haft */ 

detertni ne_sh i f tabi I i ty_var i abl es( ) ; 

if ((engine communication active) && 
(R7A7 type != BASE) && 
(R747~type != DUAL FORCE)) 

< 

if ((desired_sync_testjnode »= TRUE) && (output_speed_f i Itered < 100)) 
cont ro I _eng i ne_sync_t es t_mode( ) ; 

else 

< /* start of normal engine_commands switch */ 

switch (engine commands) 
( 

case ENGINEERED IP: 

c on t ro I _eng i ne_pr ed i pi ) ; 
break; 

case ENGINE.SYNC: 

c on t ro I _eng i ne_sync ( ) ; 
break; 

case ENG I NE_REC0VERY : 

con t ro I _eng i ne_r ecovery ( ) ; 
break; 

case ENGINEJDLE: 

control_engine_idle( ); 
break; 

case ENGINE_START: 

control JSnQint_ttert(); 
break; " 

case ENGINE^FQUOWMt 
default: 

cont rol_engine_fol I ower ( ) ; 

break; 

> 

> /* end of normal engine_commands switch */ 

switch (eng brake command) 
C 

case ENG 8 RAKE OFF: 

retarder_control = TQRQt£_CONTROL; 
desired_retarderjxt_trq » 0; 
break; 

case ENG BRAKE FULL: 

retarder^control ■ TOftOUE_COMTROL; 
desired^etarder^pct.trq » -100; 
break; 

case ENG_8RAKEJ0LE: 



default: 

retarder.conirol « 0Vmi06 s 0ISABt£D; 
de*i red_ratarder_pct_trq « 0; 
break; 

> 

> 

etst 

engine_status » EMG!NEJfOTJ>RE$€NT; 

/* store old valua for usa in "controt_engine_fol lower" function 
accelerator_pedal _position_old • accelerator^pedal.position; 

x_sync j)er i od i c ( US_PER_100P ) ; 



endjjeriodicO; 



Unpublished and confidential. Mot to bo reproduced, 
r disseminated, transferred or used without the prior 

r written consent of Eaton Corporation. 

r Copyright Eaton Corporation, 1994 

r AU rights reserved. 

r****************«*****^* *********************************************** 

r Filename: pr_s_i_s.c96 (R-747) (AutoSpLit) 
r Description: 

r The modules contained within this compilation unit are 
' intended to implement functionality of the Process System 
' Input Signals task defined in the design document ion. 
r In general, Analog to digital conversions are started on 
r PortO. The necessary hardware initialization and variable 
r initial izt ion for inputs on PortO are handled. The switch 
r inputs are captured to avoid conflict with AO conversions 
' and all necessary scaling and error check for these inputs 
r is conducted. 

' Part Number: <none> 

r $Log: ? 

r Rev 1.3 9 Dec 1994 15:06: markyvech 

r Added u trns_act.h u to the includes so that R747_type could be use to 
r determine if the electric shift knob is a splitter type or a intent to 
r shift type. 
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r Converted for use with R-747 program. (Added clutch & range switches) 
r Also re-scaled ECU-B ignition A2D code to work in ECU- 1 1 . 

Rev 1.1 19 May 1994 11:32:26 markyvech 
1 Converted for use with AutoSplit ECU 2 

* Rev 1.0 12 Sep 1991 08:04:26 amsallen 

* Initial revision. 



* 

* Header files included. 
* 



tinclude <exec.h> /* executive information */ 

# include <kr sfr.h> /* KR special function registers */ 

#include <krjief.h> /* KR definitions */ 

#include <c_regs.h> /* KR internal register definitions */ 

# include <wwstib.h> /* world wide software definitions */ 

#include "pr^s^^s.h 41 /* process system input signal information V 

#include "sysgen.h" /* defines the task names and priority */ 
# include M cont sys.K N 
^include »trns~act.h* 

* 

* «defines local to this file. 
* 

******************* *****************************************************/ 



/* S tar t_AD_Convers ions */ 

#def ine ENABLE AO PTS SCAN 0X20 
#define ENABIE~A0*ISR~0X20 



«define PER I 00 10U 
#define RKH PERIOD 50U 



/* 10ms V 
/* 50ms V 



* Constants and variables declared by this file. 



/* Digital Inputs on Portl V 

uchar spli tter_select_switch; 
uchar intent_to_shif t_swi ten; 
uchar intentJioTd; 
uchar intent_hold_timer; 
uchar range_select_switch; 
uchar in_gear_sui ten; 
uchar spTitter_launch_state; 
uchar clutch_state; 

/* Analog Inputs on PortO */ 



int ignition_vol ts; 
int splitter^position; 

«define IGNITION VOLTS CHANNEL RESULT 1 
#define SPLITTER~POS CHANNEL RESULT 15 



idefine CONVERSION TIME Oxef 



#def ine CONVERT 8 8 



/* for state time ■ 125 nsec: V 
/* sample time * 3.6250 usee */ 
/* convert time ■ 20.1875 usee */ 
/* scan and convert 8 channels */ 



#define CONVERTJGNITION_VOLTS 
#define UNUSED CHANNEL 1~ 
#define UNUSED~CHANNEL~2 
#define UNUSE0~CHANNEl"3 
#def ine UNUSED~CHANNEL~4 
#define UNUSED~CHANNEL 5 
#define UNUSED~CHANNEL~6 
#define CONVERT SPLITTER POS 
#define STOP CONVERSION " 
#define START CONVERSIONS 



<_N0RM_M00E 
(~N0RM~M00E 

<~norm"mooe 

<~NORM~MO0E 

<~norm~mooe 

<~N0RM~MO0E 

<~norm~mooe 
<~norm~mooe 

0x00 
ad command 



10 8IT MODE 


_STRT a 


_CONV 


_CHNL^ 


0 


10~8IT~M00E 


"strt" 


"CONV 


"chnl" 


"l 


10~BIT~M00E 


"strt" 


[CONV 


"chnl" 


"2 


10~8IT~M00E 


"strt" 


"CONV 


CHNL 3 


io"bit"mode 


"strt" 


"CONV 


~CHNL~4 


io"bit"mooe 


"strt" 


"CONV 


"CHNL - 5 


10~bit~mode 


"strt" 


"CONV 


~CHNL~6 


io~bit~mode 


"strt" 


"CONV 


~CHNL~7 


CONVERT IGNITION 


VOLTS 





/* table containing AD_result and AD_Command values after PTS scan */ 
uns i gned i n t AD_T ab I e M 63 ; 

/* AD SCAN PTS CONTROL BLOCK LOCATION */ 
_ad_ptsb_type AD_Con_B lock; 

Ipragma Tocate(AD_ConJ5lock=0x01F8) /* locate pts control block V 

#pragma pts(AD_ConJHock = 5) /* set pts vector 5, A/D done */ 



#pragma EJECT 



Function* Initial lzejnput_31gnels 

Description: 

This routine initialize* the A/O converter. It sets the A/0 to 
run in PTS scan node, 10b it conversion. The PTS control block is 
set up and the Caraand/result table is initialized. 



void Initialize Input Signals(void) 

/* if we knew when the first speed packet a 
with those values, since we don't, be s 



AO Table CO] 
AD Tabled] 
AD~Table[2] 
AD Table [3] 
AD~Table(4] 
AD~Table(5] 
AD~TableC6] 
AD Table [7] 
AD~Table[8] 
AD~Table(9] 
AD~TableC10J 
AD~Table[11] 
AD Table[12] 
AD~TableC13j 
AD TabletU] 
AD TabledS) 



a UNUSED_CHANNEL_1 ; 

■ 0x0000; 

■ UNUSED_CHANNEL_2; 
a 0x0000; 

» unuseo_channel_3; 

* OxOOOOj 

» UNUSED_CHANNEL_4; 

■ 0x0000; 

» UNUSEDj:HANNEL_5; 
= 0x0000; 

« UNUSED_CHANNEL_6; 
= 0x000 oj 

= CONVERT_SPLITTER_POS; 

= 0x0000;" 

= STOP.CONVERSION; 

* 0x0000; 



AD Con Block. cnt = CONVERT 8; 
AD~Cqn~Block.ctrl * _ADJ400E |_SJMJPDT; 



AD_Con_Block.s_d = AD_Table; 

AD^Con^B lock, rig ■ (void *)&_ad_result; 

_ad_time = CONVERSION^ I ME; 

~ad~test * NO OFFS; 

jjts select "( PTS AD00NE BIT); 



rived, we could initialize 
fe and use zero. */ 

place holder for channel 1 
IGMIT ION_VOLTS_CHANNEL_RESULT 
place holder for channel 2 
UNUSEDJ_RESULT 
place holder for channel 3 
UNUSE0_2_RESULT 
place holder for channel 4 
UNUSED_3_RESUIT 
place holder for channel 5 
UNUSED_4_RESULT 
place holder for channel 6 
UNUSED_5_RESULT 
Command convert splitter pos 
UNUSED_6_RESUIT 
command to Stop conversions 
SPLITTER POS CHANNEL RESULT 



A/D mode bits 0,1 of PTS_CONTROL 
always set to 3h bit 2 * 0 
S/D update at end of cycle 
bit S always 0 
Set mode for AO SCAN 



Load s_d with AD_Table address */ 
Load reg with AD~Result address */ 



* Disable test mode */ 

* Disable AD PTS */ 



#pragma EJECT 



Function: AO J $8 
Description: 

This interupt strvlce routine resets the PTSCOUNT, pts_sd and pts_reg 
for another PTS_Scaw A/O cycle. It also readies a task~to run when 
a PTS cycle has coapleted. 



/ 



ipragma interrupt (AO 1SR*5) 

void AO ISR(void) 

€ 



x_start_isr(); 

AO Conjilock.cnt = CONVERT 8; 
AO^Con^Block.s^d * AD_Table; 
AD_Con_8 lock. res a (void *)&_ad_resul t; 



/* Reset pts count for next cycle V 
/* Reset table pointer to start of table 



x_ready ( PROCE SSJNPUT_S I GNALS ) ; 
x~end_isr(); 



/* Ready pr_s_i_s task V 



> 



#pragma EJECT 



* Function: S t art Jfc.Convers font 

* Description: 

* This function initializes the input signal processing function 

* if it has not already been done, and then startes the PTS Scan 

* of the AO channels by sending the appropriate command to the 

* ad_coanand register. 

* "" 

void Start AO Conversions(void) 
< 

if <<_intjnask & ENABIE_ADJSR) » 0 ) 

InTtiaTize^Input^SignalsO; /* Set up AO table for PTS * 

_ptS select |= ENABLE AO PTS SCAN; 
Jntjnask |= ENABLE_AOJSR; 

x_pr ea rtn_s t i mu I us < ) ; 

START JTON VERS IONS; /* Start a conversion, initiate the PTS cycles V 
x_wait_stimulus<); /* AO_ISR will ready task when PTS is complete V 



#pragma EJECT 



Funct i on: reed_sui tchj nputs 

Description: 

Read the state of the digital inputs. 



****************** 



void read switch inputs(void) 
( 

if <portJ_switches & 0x1) /* P1.0 V 

in_gear_swi tch = TRUE; 
else - 

in_gear_switch * FALSE; 

if <portJ_switches & 0x2) , /* P1.1 */ 

range_se7ect_swi tch = LOW; 
else 

range_select_switch * HIGH; 

if (R747 type « INTENT) 
C 

if (port 1 switches & 0x4) /* P1.2 V 

< 

intent_to_shift_swi tch = FALSE; 

if (intent_hold_timer < 25) 

intent_hold_t imer += 1; 
else 

intent hold = FALSE; 

> 

else 
{ 

intent_to_shif t_switch = TRUE; 
intent hold timer = 0; 

> 



else 
i 

if (port_1_switches & 0x4) /* PI. 2 V 

splitter~select_switch = HIGH; 
else 

splitter select switch = LOW; 

> 

if ((port_2_switches & 0x30) == (0x10)) 

clutch_state = ENGAGED; 
else 

clutch_state =« DISENGAGED; 

#if (0) 

if (port_1_switches & 0x4) 

splitter Jaunch_atate » LO_SPLITTER; 
else 

splitter launch state » HI SPLITTER; 
#endif 

splitter_launch_state * LO_$PlITTER; 



#pragraa EJECT 



* Function: proceesJnput_signsls 

* ~ 

* Description: 

* This is the periodic task which starts the analog conversions on PortO. 
* 

void process input signats(void) 
( 

intentjiold = FALSE; /* initialize intent_hold V 

x start_periodic(); 

while (1) 

< 

reed_sui tch_inputsO; 

S tart_AD_Convers i ons( ) ; 

/* Clean up and scale AO values */ 

ignition^ volts = scale_system_ad_inputs(IGMITION - VOLTAGE); 
splitter^position » scale_system2ad_inputs(SPLITTER_POSITIOM>; 

x syiKjseriodicC PER 1 00*1000); 
/* x sync_periodic<R»CM PERIODMOOO); */ 
> 

x end_periodic(); 

> 

#pragma EJECT 



* Function: scale_systea_adjnputs 

* Description: 

* This function removes the channel, status and reserved bits from 

* the raw AO values, and performs all necessary scaling and error 

* checking for the analog inputs on PortO. 

**«************************♦*#****«***#*********************************/ 

int scale system ad inputs (char Channel) 
C 

int Scaled_Value = 0; 
uint volts^per_bit; /* BIN 16 V 
uint units_per~bit; /* BIN 16 */ 
/* idefine TWELVE VOLT FULL SCALE 22.46 V /* ECU.B volts */ 

#define TWELVE VOLT FULL SCALE 34.51 /* ECU 2 volts */ 

#define TWENTY~FOUR~VOLT~FULL SCALE 40.49 /* volts V 
#define DISTANCE FULL SCALE 100 /* V 



volts_per bit * (uint) ((TWELVE VOLT FULL SCALE*65536/1023)*0.5); 
units _per~bit * (uint)((DISTANCE_FULL_SCALE*65536/1023)+0.5); 

switch (Channel) 
i 

case 0: /* IGNITION VOLTAGE V 

CX * AD Table [IGNI T ION VOLTS CHANNEL RESULT] » 6; 
asm mulu" cxdx, volts_per bit; /* volts, BIN 16 (_dx, BIN 0) */ 
ScaledJ/aTue = *(int *>&_dx; 
break; 

case 1: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled_Value - (0); 
break; 

case 2: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled J/alue = (0); 
break; 

case 3: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled J/alue * (0); 
break;" 

case 4: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled J/alue * (0); 
break; 

case 5: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled J/alue = (0); 
break; 

case 6: /* UNUSED */ /* to be completed when a product requires it */ 
Scaled.Value * (0); 
break; 

case 7: /* SPLITTER POSITI0D */ 

cx * AD Table CSPUTTE* POS CHANNEL RESULT] » 6; 
asm raulu" cxdx, unita_per bit; /* distance, BIN 16 <_dx, BIN 0) V 
ScaledJ/aTue « *(tnt *>*Jbt; 
break; 

default: 
break; 

> 

return (ScaledJ/alue); 
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* 

* Filename: seq_shft.c96 (R-747) (AutoSplit) 
• 

* Description: 

* The functions in this file will perform the required systesi 

* level operations for implementing Sequence Shift. 
* 

* Part Number: <none> 
* 

* Rev 1.2 12 Dec 1994 09:15 markyvech 

* In function u sequence_shift() u added code for the intentjiold. 

* ~~ "~ 

* Rev 1.1 09 Dec 1994 08:07 markyvech 

* In function "sequence_sh i f t<)" added code for the intent to shift 

* feature. This will allow shif t_ini tiate, (predip mode), to be called. 

* Also added code to allow for the cancellation of intent to shift if 

* conditions allow, (call confirm shift). 
* 

* Rev 1.0 12 May 1994 16:26:00 markyvech 

* Initial version 
* 



,************************ 

* Header files included. 



^include 
#include 
#include 
#include 
# include 
# include 
# include 
#include 
# include 
# include 
#include 
# include 



<exec.h> 

<c_regs.h> 

<wwslib.h> 

"cont sys.h" 

l, conjT939.h» 

"con o s.h" 

"drrcmds.h" 

"set'gear.h" 

»shf"tbl.h» 

"trn~tbl.h" 

"trns.act.h" 

"pr_s~i_s.h" 



/* executive information */ 

/* KR internal registers */ 

/* World Wide Software Library */ 

/* control system information */ 

/* Defines interface to engine communications info 

/* control output signal information */ 

/* drivel ine commands information */ 

/* Contains information relative to engine */ 

/* transmission table information */ 

/* transmission information */ 

/* process system input signals information */ 



* #defines local to this file. 
* 



* publics. 



************ 



************ 



unsigned char forced_predip_timer; 
unsigned char ini t_dest_gear_timer; 
signed char ini tTal_destination_gear; 



* 

* Constants and variables declared by this file. 

***********«.****•********•**•*•*********•*********•****•**•************/ 

static uchar coast jnode; /* allows vehicle to coast in low gears */ 



#define FORCED PREDIP TIME 150 /* 300 MSEC at 5 counts per loop */ 

fdefine ! M_SYMC_M00E_T I KE_l IMIT 200 /• 2 SEC */ 



function* Initial fzt_s«quinc*_sMft 

Description: 

This function initialize* those nodule variables that oust be set to a 
know state on power up or reset. 



void initialize sequence shift(void) 
C 

shift_type = UPSHIFT; 
ahift_in_process * FALSE; 
forced_predip timer * 0; 

> 



fpragroa EJECT 



ACAAAAAtlft £ ft ###4 ft Aft ftAiftftft4ftft#ftftftftftft ft ft ft ft'ftftftft-AftftftftftftAft ftftftftftftftftftftft ft^ 

* Function: shlftjnitiatt 

* ™ 

* Description* 

* This function begin* the shift sequence by setting up the 

* transmission to pull to Neutral, coamands the electronic engine 

* controller to go to zero torque and prepares the clutch to disengage 

* if required. 
* 

static void shift ini tiate(void) 



/* (do not request engine fueling with engine brake on) */ 
eng_brake_command * ENG_BRAKE_OFF; /* eng brake: zero torque V 

if ((lpf_output_speed < shf_tbl .rnin_output_spd) || 

<clutch_state DISENGAGED) || 

( (coast jnode) && (shift.type I* UPSHIFT) && /* Prevents engine control */ 
((destination_gear < 3)"|| /* in low gear(s) downshifts. V 

((destination~gear < 4) && (accelerator_pedal_position <» 5))))) 

i 

engine commands = ENGINE FOLLOWER; 

> 

else 
i 

engine_commands = ENGINEJ>REDIP; /* engine: bring torque to zero */ 

coast mode = FALSE; 

> 

> 

tpragma EJECT 



* Function: synch r on f ze_gear 

* ™ 

* Description: 

* This function assists the sychronizing of the transmission by 

* utilizing SA£ J1939 functions to control an electronic engine. 



static void synchronize gear(void) 
C 

/* turn on engine brakes (J 1939) if engine brake assisted shift is revested */ 

if (eng brake assist) 

eng_brake.cotrmand « ENG_BRAKE_FUL L ; 
else 

eng_brake_coninand =« ENG_BRAKE_OFF; 
if <<lpf_output_speed < shf_tbl.min_output_spd) || 
(clutch _state =» DISENGAGED) || 

((coastjnode) && (shift_type !» UPSHIFT) && /* Prevents engine control */ 
((destination_gear < 3)~|| /* in low gear(s) downshifts. */ 

(<destination~gear < 4) && (accelerator_pedal _posi tion <= 5))))) 

( 

engine commands = ENGINE FOLLOWER; 



else 
C 

engine_comjnands = ENGINE_SYNC; 
coast mode = FALSE; 

> 



if ((engine status f= ENGINE SYNC KOOE) && 
(engine~commands == ENGINE_SYNC) ) 
init_dest~gear_timer * 0 ; 

if (init dest gear timer < 8) 

initial_destination_gear = des tinati on_gea reelected ; 
init dest gear timer**; 

> 



/* Save the initial gear V 
/* to check for a new one */ 
/* as the shift progresses. V 



else 



if ((engine_status == ENG I NE_SYNC_MOOE ) && 



/* If the gear changes, */ 



(initial_destination_gear != destinat ion_gea reelected)) /* force the predip mode */ 



forced_predip_timer * FORCED^PRED I P_T I HE ; 
forced_predip » TRUE; 



/* to allow the splitter */ 
/* to move. */ 



tpragma EJECT 



* Function: conf ir»_shif t 

* Description: 

* This function finishes the shift; shift_in_process is set FALSE* 

static void confirm shift(void) 
{ 

engine_commands 3 EMG I NE_RECOVERY ; /* engine: finish torque return 

eng_brake_c ocmand = ENG_BRAICE_OFF; /* eng brake: zero torque */ 

shift_in_process = FALSE; 
coast jnode » TRUE; 



fpragma EJECT 



Function: sequence.shift 



Description: 

This function calls the appropriate procedures to perform the 
operations of Sequence_Sh I f t depending on the current state of 
the shift process. 



void sequence shift(void) 



if (destination gear < last known gear) /* determine shift type */ 
< 

if (pet demand at cur sp > 5) 

shift~type *>OWER_OOWN_SHIFT; 
else 

shift type = COAST DOWN SHIFT; 

> 

else 

shift_type = UPSHIFT; 

if ((forced_predip_timer >= A) &4 /* Time out a forced return to the predlp mode */ 
(g_ptr « 0)) /* if the destination gear selected changes */ 

forced_predip_timer -= 4; /* during the sync mode. */ 

if (forced_predip_timer > 0) 
f orced_predi p_t imer- * ; 

if (destination gear « NULL GEAR) /* System has reset: do not start a shift */ 
C 

engine ccmnands = ENGINE FOLLOWER; 
eng brake command = ENG BRAKE IDLE; 

> 

else 

if ((transmissionjsosition == OUT_OF_GEAR) && 
(forcedjsredip timer == 0) && 
((engine status"— ENGINE SYNC MOOE) || 
(engine'status == ENGINE~PRED7p MOOE))) /* forces shift initiateO */ 

< " y 

synchronize gear(); ^^^^ 

> 



else 

if ((((engine status ENGINE SYNC MOOE) || 

( engine's tatus == ENGINEJIECOVERYJ400E)) U 
( f ore ed_predip_ timer == 0) && 
(destination^gear == current_gear) && 
(transmissionjMsi tion =» I N_GEAR ) ) || 

((shift_in_process == TRUE) && /* cancel intent to shift if */ 

(intent to shift switch «» FALSE) U /* conditions allow it. */ 
(shift_7nit_tYp*~»« MANUAL) U 
< automat ic_Iip » 0) U 
(transmission ^position M Itt GEAR) U 
(engine status » EMCI«_P«£DIP MOOE))) 

i 

conf f rm_shlft(>£ 



else 

if (((destination_gear !» current_gear) && /* auto splitter */ 
(low_speed_latch »» FALSE) U~ 
( automat ic~sip 1= 0) W 
(transraission_posi tion IN_GEAR)) || 

((intent_to_shift_switch « TRUE) && /* Allows for intent_to_shift 

(desired gear !=~destination_gear_selected) && /* manual shift. 
< intent .hold == FALSE) && 
( automat ic^sip 3 = 0) && 
(shift tnit type == MANUAL) && 
(low_speedJatch == FALSE) && 
(transmission_posi tion *» 1N_GEAR)) || 



(forced_predip_timer > 0) || 



/* gear changed during shift */ 



((transaission^osition » OUT Of GEAR) U /* nrosl shift V 
(ton spt«djatch ~ FAlSi))) " 

{ 

shift initiate); 

> 
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* Filename: sel gear.c96 (R-747) (AutoSplit) 

* ~ 

* Description: 

* This module is the periodic task "selec^gear". It assigns values 

* to destination_gea reelected as a function of selectedjnode, input 

* and output shaft speeds. 

* Shift parameters are in the data structure shf_tbl. 

* ~ 

* Part Number: <none> 
* 

* Rev 1.1 12 Dec 1994 08:05 markyvech 

* In function "determinejnanual_shif t_pts< ) u , changed auto_up_rpm from 

* 1350 RPM to 1425 RPM because the transmission has been changed to a M B tt 

* ratio and skip upshifts need to be avoided. 
* 

* Rev 1.0 14 Sep 1994 14:02:00 markyvech 

* Initial revision. ^ 
« 

★★♦♦★★★★A***************************************************************/ 
* 

* Header files included. 



#include <exec.h> /* executive information */ 

#include <c_regs.h> /* c registers */ 

#inctude <wwslib.h> /* contains common global defines V 

#include "cont^sys.h" /* control system V 

#include "con j 1939. h" /* defines interface to j 1939 control module */ 

#include !, drl_cmds.h" ; /* drivel ine commands information */ 

^include "sel^gear.h" /* select gear */ 

#include "shf'tbl.h" /* shift table definition */ 

#include "trn^tbl ,h" /* (system) transmission table definition V 

M include "calc^spd.h" 

#include "trns^act .h" 

#pragma no reentrant 

* 

* #defines local to this file. 
* 

#def ine USJ>ERJ.OOP 40000U 

#def ine IN I T I AL_START_GEAfr 1 

#define SHIFT_INHIBIT_D£CEL_L!M!T -150 



* 

* Constants and variables declared by this file. 
* 



/* public */ 

char destination_gear_selected; 

char destination^gear; 

char f I ash_des i red_a 1 I owed; 

char desired_gear;~ 

char des i reef gear_dn; 

char des i red_gear_up; 

uchar coasting_latch; 

uchar sh i f t_i n i t_type; 



int dot ^predicted; /• BtM 0 V 

int dot _prdtdJi»noJtl»; /* BIN 0 V 



/* local */ 

/* filter weights for tht "rada" output speed filter V 
static register uchar w1; 
static register uchar w2; 
static register uchar w3; 
static register uchar w4; 

/* shift table (define and extern in shf_tbl.h) */ 
struct shf_tbl_t shf_tbl; 



/* default shift table values */ 
const struct shf tbl t ini shf tbl « 
i 



1200, 


/* 


aut_dwn_rpm */ 


1000, 


/* 


•utjai n~dwn_rpm */ 


1700, 


/* 


aut_up_rp» */ 


o, 


/* 


best_gr_offset */ 


50, 


/• 


dwn_offset_rp» */ 


inn 


/ 


Qwn_rcsei_rpni / 


400, 


/* 


dwn~t imer~of f set_rpni */ 


40, 


/* 


hysteresis_rpm *7 


1850, 


/* 


man_dwn_sync_rpra V 


700, 


/* 


man_up_sync_rpm */ 


1900, 


/* 


rated_rpm */ 


150, 


/* 


up_offset_rpm */ 


125, 


/* 


up_reset_rpm */ 


200, 


/* 


up_timer_offset_rpm */ 


o» 


/* 


.dwn_acceT */ 




/* 


up_accel */ 


3000, 


/* 


offset_time */ 


<uint)(0. 25*256), 


/* 


aut_upjxt V 


10, 


/* 


minjxjtput_spd */ 


1, 


/* 


max~start_gear */ 


o. 


/* 


padbytel */ 


196, 


/* 


k1 ability, min- ft/rev-sec, BIN 12 */ 


431, 


/* 


axTe_ratio_cal, BIM 7 */ 


383, 


/* 


gew k1, rev/sec-min-ft, BIM 0 */ 


2437, 


/* 


gcw~k2, rev/sec*2, BIN 7 V 


1325, 


/* 


calc_start_point, rpm, BIN 0 */ 


107, 


/* 


k6_ability, min-lb-ft-sec/rev, BIN 8 */ 


1500, 


/* 


auto_up_lo_base, rpm, BIN 0 V 


1100, 


/* 


auto_dn_lo_base, rpm, BIN 0 */ 


100, 


/* 


auto~rtd_offset, rpro, BIN 0 V 


1000, 


/* 


I owest_engage_rpm, BIN 0 V 


o, 


/* 


padwordl */ 


0 


/* 


padword2 */ 



>; 



/* local initialized at start of task by select_gear */ 

/* shift points with ant i -hunt offsets; referenced by auto_downshift and 

autojjpshift; set by get_autoraatic_g*ar and select_gear~*/ 
uint upshift _point; " ~ 

uint downshiftjDoint; 

/* lower limit for gear selections V 
char lowest_forward; 

/* indicate direction of a get_automatic_gear shift; referenced by 

getjnanual_gear; cleared by~select_gear when shift complete V 
char automatic_sip; 

/* used in the determination of shift_points based on throttle position * 
static uint autojjp_rpm; 
static uint auto_dn_rpm; 
static uint autojjp^of fset_rpm; 
static uint auto~dn~of fset'rpm; 

/* delay counter for ant i- hunt */ 
static uchar antihunt_counter; 

/* gross combined weight calculations V 



•define ZERO SPCIO TIME LIMIT 450* 
Mtf int VALID 0L0 OsATA TIK 100 
•define MAX VEHICLE UiTcST 100000 
•define D0$"0lfSST TlilT 46 
•define EMC~0ECEL LOU LIMIT -350 
•define EMC 06CEL LPf" 224 



/* 3 «fn d 0.040 ptriod V 
/* 4 sec a 0.040 period V 
/* 100,000 lbs V 

/* rpatfs */ 

/* exp<-2pi<0.53Hz)<0.040s>) * 0.875 (8IM 8) */ 



•ff (0) 
static ulong 
static long 
static uint 
static uloog 
static uchar 
static uchar 
static uchar 
static uint 
static uchar 
static uchar 
static uint 
static 
static 
static uint 
static uchar 
static uint 
static int 
static int 
static int 
static uchar 



int 
int 



gross_coctained_weight ; 
gcw_local; 
gcw~locel_counter; 
9cw_local_total; 
va I 7d_o I d_data_count er ; 
missed_shTft_offset_ann; 
gcw_caTculatTon_al lowed; 
iero_speed_counter; 
gcw_7irst_shift; 
dos_f i lter_latch; 
gcw^cal_new; 
dos~f tltered_old; 
dos~offset; 
sync_del ta_t imer; 
disjfilter~latch; 
i nput_spd_7i rs t_poi nt ; 
eng_deceOatest; 
eng~decel^rate; 
engjtecel j-ate^wth^jakej- 
used^engJSrk; 



/* shiftability calculations V 

•define TORQ ACC LPF 230 

•define K7_ABILITY 249 

•define FIXED LIMIT -30 

•define FIXED J.IMITJ -36 

#define SHF_BLY_HOLD_COUNT 3 

static uchar shif tabi I i tyjiold; 
static uchar shi f tabi I i ty~hold_II ; 
static uchar shf_bly_hold~cntr~ 
static int dos_predicted_raw; 
static long dos_predicted_bin8; 
static long dos_predictedjjartial_1; 
static long dos_predicted _partial_2; 
static int dos _prdtd_l im_wth_jakej 
static int vehicle_accel_bs; 
static int vehicle_accel_as; 
static int engine^ torque; 
static int torque~at_wheels; 
static int torq_to_accel_eng; 
static uint gcw caT; 
static uint TRANS_STEP_SIZE_CAL; 
static uchar torque accessories; 
•endif 



/* lb-sec'2, BIN 0 V 



/* 0.9000 BIN 8 */ 
/* 0.9730 BIN 8 */ 



/* 120 ms a 0.040 period */ 



/* 
/* 
/* 
/* 
/• 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 



BIN 0 
BIN 8 
BIN 8 
BIN 8 
BIN 0 
BIN 
BIN 
BIN 
BIN 
BIN 



*/ 
V 
V 

*/ 

V 
V 
V 

*/ 
*/ 
*/ 



lb-sec"2, BIN 0 V 
#, BIN 8 V 
tb-ft, BIN 0 */ 



#pragma EJECT 



Function: ada_output_f Uttr 



* Description: 

* This is a one pole LPF with a variable coefficient. The magnitude 

* of the coefficient is directly related to the acceleration content 

* of the speed sample and the frequency. 

***************************-***#*************#************************+** / 

static void mda output filter(void) 
( 

tfdefine K1 8 
#define K2 24 
#define IC3 48 
#definc K4 160 

static register uint os_delta_speed; 
static register uchar weight; 

if ( lpf_output_speed > output_speed) 

os_delta_speed = I pf _output_speed - output_speed; 
else 

os_delta_speed a output_speed - I pf _out put _s peed; 

if (os delta speed <= K1) /* delta <* 200 rpm/s */ 

C 

if (w1 > 1) --wl; 
if <w2 < 5) ++w2; 
if (w3 < 6) ++w3; 
if (w4 < 7) ++w4; 
weight = wl; 

> 

else if (os delta speed <= K2) /* 200 rpm/s < delta <= 600 rpm/s */ 
( 

if (wl < 4) ++w1; 
if (w2 > 2) --w2; 
if (w3 < 6) *+w3; 
if (w4 < 7) ♦♦w4; 
weight = w2; 

> 

else if (os delta speed <= K3) /* 600 rpm/s < delta <* 1200 rpm/s */ 
C 

if (w1 < 4)'*+w1; 
if (w2 < 5) ++w2; 
if (w3 > 3) -w3; 
if (w4 < 7) ++w4; 
weight = w3; 

> 

else if (os delta speed « K4) /* 1200 rpm/s < delta <» 4000 rpm/s */ 



if (w1 


< 


4) ++w1; 

5) ++w2; 


if (w2 


< 


if (w3 


< 


6) ++w3; 


if (w4 


> 


3) -w4; 


weight 


s 





> 

else /* 4000 rpm/s < delta V 

i 

if (w1 < 4) ++«t.; 
if (w2 < 5) ++*2; 
if (w3 < 6) ♦♦wJ; 
if (w4 < 7) ♦♦w4; 
weight * 7; 

> 

lpf_output_speed * lpf_output_speed ♦ 

(output~speed » weight) -~(lpf output speed » weight); 

> 

fpragma EJECT 



* Function: new_ i nput_spe«d 

* Description: 

* A utility function that returns the input shaft speed expected if 

* "gear 4 * was engaged with the present output shaft speed. 

••A********************************************************************* 



static uint new input speed(char gear) 
< 

/* new_input_speed = I pf _out put _s peed * gear-ratio */ 

_ax » trn_tbf.gear_ratio7gear ♦~GR_0FSJ; ~ /* BIN 8 */ 

asm mulu "axbx, lpf_output_speed; ~ /* BIN (K8*8 <_axbx) V 

asm shrl laxbx, *8;~ ~ /* 8IN 8»«0 ("ax) •/ 

return ax; 

> 



#pragma EJECT 



* Function: auto upshift 

* ~ 

* Description: 

* This boolean function returns true when automatic upshift 

* conditions have been net. 
* 

static int auto upshif t(void) 

if <(gos > upshift _point) &4 (output speed filtered > 120)) 
i ~ 

if (engine communication active) 

< 

/* if Ulshiftabilityjiold) U ( Ishif tabi I i ty_hold_I I)) */ 
return 1; " ~ 

> 

> 

return 0; 



#pragma EJECT 



* Function: eutojiownshift 

* Description: 

* This boolean function returns true when automatic downshift 

* conditions have been net. 
* 

static int auto downshift (void) 
< 

if <gos < downshift_point) 
C 

return 1; 

> 

return 0; 

> 

#pragma EJECT 



* Functions deterttint_autoeplit_typ* 

* Description: 

* This function is used to determine if the impending shift type is 

* MANUAL or AUTO. 



static char determine autosplit type (char passed new gear, char passed initial gear) 
< 

register char new_gr - passed_new_gear; 

register char init_gr » passed w initial_gear; 



if ((shift in_process « FALSE) || 



(engine_stetus »■ ENGIHE_RECOVERY_MOOE)) 



if 



((new_gr so 

(new_gr « 

(new_gr *■ 
(nev_gr 

(new_gr =■ 

<new_gr » 

(new_gr == 

<new_gr == 

(new_gr == 

(nefcTgr == 



1 U 

3 U 

5 && 

7 « 
9 && 

10 &i 

8 &* 

6 U 

4 && 

2 && 



shif t_init_type = AUTO; 



t_gr *■ 
t~gr « 
t~gr = 
t_gr a 
t gr » 
Or = 
t_gr = 

t_gr = 
t gr = 
t~gr = 



2) 
4) 
6) 
8) 
10) 
9) 
7) 
5) 
3) 
D) 



/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 



*/ 
V 
*/ 
*/ 
*/ 
*/ 
*/ 
V 
*/ 
V 



else 

shiftjnit_type = MANUAL; 



#pragma EJECT 



* Function: get_automatic_gtar 

* Description: 

* This function determines the appropriate gear for both automatic 

* splitter shifts and manual lever shifts. 
* 

************************************************************************/ 

static char get automatic gear(char initial gear, char manual request) 
< 

register char new_gear = ini tial_gear; 

if (automatic sip != -1) 
< 

/* initiate or continue an upshift: search up from lowest_forward 

(fastest input speed) for the first available gear that will provide input 
speed below a value (approx upshift rprn, minus an offset for gears that will 
result in a net downshift) */ 

for (new_gear = lowest_forward; 

(new_input_speed(new_gear) > (upshif t_point - 
(new_gear < initial_gear ? 

(shf_tbl .up_of fset_rpm ♦ auto_dn_of fset_rpm) : shf_tbl .best_gr_of fstt))) 
&& (new_gear < trn_tbl ,highest_forward7; 
♦+new_gear) 



if ((ini tial_gear == 3) && ((new_gear ==2) || (new_gear == 1))) 
new_gear = ini tial_gear; 

desired_gear = new_gear; 
desired_gear_up = new_gear; 

determine_autospl i t_type(new_gear, initial_gear); 

/* if lever shift and still in gear, keep initial_gear */ 

if (((shift_init_type == MANUAL) && (transmissionjxsition == IN_GEAR)) || 

(( automat ic_sip == 0) && (new_gear <= initial_gear)) || 

((dgos < SHI FT_lNHIBIT_DECEL_t 1MIT) && 
((transmission_posi tion == IN_GEAR) || 

((transmission_position == OUTJDFJSEAR) && (shift_init_type « AUTO))))) 
new^gear = ini tial_gear; 
else 
i 

/* indicate gear change and adjust downshift_point */ 

automat ic^sip = +1; 

auto_up_offset_rpm = 0; 

if (shift_init~type == AUTO) 

auto_dn_offsetj-pm = shf_tbl ,dwn_timer_of fset_rpm; 
else " ~ " 

auto dn offset rpm = 0; 

> 

> 



if ((automatic sip l> 1) && (initial gear > lowest forward)) 
< 

/* initiate or continue an downshift: search down from 

highest_foruard (slowest input speed) for the first available gear that will 

provide' input speed above a value (approx downshift rpm, plus an offset for 

gears that will result in a net upshift) */ 
for (new_gear » trn_tbl .highest_forward; 

(new_input_speed(new_gear) < (downshift^point ♦ 

(new_gear > initial_gear ? shf_tbl .dwn_of fset_rpra : shf_tbl .best_gr_of fset))) 

&& (new_gear > lowest_forward); 

--new_gear) 



if ((initial_gear « 3) && ((new_gear »» 2) \[ (new_gear »» i))> 
new_gear = initial_gear; 

des i red_gear_dn * new_gear; 

if (desired_gear_dn < initial_gear) /* Must be a down shift or else it may •/ 
desired_gear « new_gear; /* wrongly cancel the detired_up pick. V 



ofct«f*1r»_auto*ptit_typs<ns*i„>e«r # initistjHsr); 

/* if lever shift and still in g*«r, keep initial gear */ 

if (((shift Jnit.typa « MAMMl) U (tran*aissic«fposition — I^GCAt)) || 

(( automat ic_sip «■ 0) tt (new_gear >« initial_gear)) || 

(Cdgoa < SH I FT_I NH1B1 T J)ECEl_l I M I T ) && 
((transmission ^position « IM GEAR) || 

((transmission_position « OUT_OF_GEAR) && (shif t_init_type == AUTO))))) 
ne«_gear * ini tial.gear; 
else " 
< 

/* indicate automatic gear change and adjust upshift _point */ 

automat ic_sip » -1; 

auto dn offset rpra 3 0; 

if (shiftjnit'type « AUTO) 

auto_up~offset_rpra ■ shf_tbl.up_timer_offset_rpn; 
else 

auto up offset rpra » 0; 

> 

> 

return new gear; 

> 



fpragma EJECT 



Funct 1 on: detervi ne_dest inat ion 



* Description: 

* This function uses O coasting w latch ,, to determine if a coasting or 

* skip shift is being attempted. When sensed, the latch is used in 

* the detenai ne_ba*e_pt s function to affect the base shift points. 

♦#♦♦******♦♦****♦♦**♦*♦♦«***********»«♦**•#***##****##**********#****#*#/ 

void determine destination(void) 
C 

/* if coasting in neutral - modify shift points */ 

if (coasting latch « FALSE) ^ 
i 

if ((last known gear - destination gear selected) > 1) /* multi downshift 
< 

if ((destination_gear_selected « 7) 
(destination_gear_selected *» 5) 
(destination~gear~selected == 3) 
(destination gear selected == 1)) 

{ 

dest inat ion_gear_selected++; 
coasting latch =~TRUE; 

> 

> 

else 
€ 

if ((destination gear selected - last known gear) > 1) /* multi upshift 
C 

if ((dest inat ion_gear_selec ted « 10) 
( dest i net ion~gea reelected « 8) 
(destination_gear_selected 33 6) 
(destination~gear~selected =» 4)) 

( 

dest i nat i on_gear_se I ec ted- - ; 
coasting latch » TRUE; 

> 

> 

> 

> 

else 

if (shift_in_process == FALSE) 
coasting^latch * FALSE; 

) 

#pragma EJECT 



* 

* Functions dtttrsifwjnanual^shift^pts 

* Description: 

static void deterainejnanual_shift _pts(void) 



if (coasting latch » FALSE) 
< 

if <<lastJcnown_gear == 1) 
( lastJcnowrCgear * s 3) 
( last_known_gear ==5) 
( tast~knoun~gear == 7) 
<lastjcn©wn_gear == 9)) 
auto_dn"rpm »"1325; /* manual downshifts V 

else 

auto up rpm = 1425; /* manual upshifts V 

> 



> 

#pragma EJECT 



* Function: dtttra1nt.btM.auto_shift.pts 

* Description: 

* This function determines the bast up and down shift points based on 

* the position of the throttle. These base points will be used in the 

* calculation of the upshift .point and the downshiftjxint. 
* 

* The anti-hunting calculations have been moved to this function since 

* these calculations are now throttle dependent. 
« 

static void determine base auto shift_pts(void) 
C 

if (pet demand at cur sp > 0) 
{ 

/* auto_up_rpra = shf.tbl.auto.up.lo.base ♦ 

.((shf.tbl.aut.up.rpm - shObT.auto_up_lo.base) * Xthrottle) * 

_cx « shf_tbl.aut_up.rpm - shf.tbl.auto.up.lo.base; 
.bx • pct.demand.at_cur.sp; 
asm mulu _cxdx, .bx; 
asm divu _cxdx, #100; 

auto.up.rpm = shf.tbl.auto.up.lo.base ♦ _cx; 

/* check for RTO requirement */ 
if (pct_demand_at.cur.sp > 90) 

au t o~up.r pnf ♦ =~sh f _t b I . au t o.r t d_o f f se t ; 

/* auto.dn.rpm = shf.tbl .auto.dn.lo.base + 

(7shf_tbl.aut.dwn_rpm -"shf.tbl .auto.dn_lo.base) * Xthrottle) 

_cx = shf.tbl -aut.dwn_rpm - shf.tbl . auto.dn.lo.base; 
.bx = pct.demand.at.cur_sp; 
asm mulu _cxdx, _bx; 
asm divu _cxdx, #100; 

auto dn rpm * shf tbl.auto dn lo base + cx; 

> 

else 
< 

auto_up_rpm = shf_tbl .auto_up_lo_base; 
auto~dn~rpm 3 *shf tbl.auto dn lo base; 

> 

determine_manual_shif t_pts( ); 

if (shift in _process) 
i 

/* reset antihunt_counter V 
antihunt_counter = 0; 

/* allow the knob display to flashed any new desired gear */ 
flash desired allowed ■ TRUE; 

> 

else 
t 

/* reset shift in process flags and update antihunt_counter V 

automat ic_sip « Of 

if (antihunt counter < 255) 

( 

♦♦antihunt counter; 

> 

/* look for upshift ant i -hunt reset conditions */ 

if ((antihunt counter * (US PER LOOP/1000)) >= shf tbl.offset_tirae) 

( 

/* check for last shift » upshift effects */ 

if (auto_dn_of fset.rpm « shf.tbl .dwn.timer.of fset.rpm) 

auto_dn_of fset.rpm = shf.tbl .dwn.of fset.rpm; 
else if"((auto_dn_of fset.rpm " shf_tbl .dwn.of fset.rpm) && 

(input.8peed.fTltered"> auto.dn.rpm ♦ shf_tbl.dwn_reset.rpm)) 

auto.dn.offset.rpm =0; 

/* check for last shift » downshift effects */ 
if (auto.up.of fset.rpm « shf. tbl.up.timer.of fset.rpm) 
euto_up_offset_rpm ■ shf _tbl .up.of fset.rpm; 



•Is* if ((auto.up. offMt.rps «* shf_tfcC.up_offset rpatf U 

(input_spe«d_filtered > «jto_up_qpa - sh#_tfcl.up_r*s«t_rp«)) 
auto_up_offs*t_rpai » 0; 

/* allow the knob display to flashed the desired gear */ 

if (<<desired_gear > destination_gear_selected) U (90s < (upshif t_point ♦ 25))) || 
Udes1red~gear < destination^ ear's elected) && (gos > (downshift j»int • 25)))) 
flash_desired - allowed » FALSE;" 
else 

flash desired^al lowed * TRUE; 



/* set the shift points based on throttle and determined offsets */ 
upshift _point = auto_up_rpro ♦ autojjp_of f set_rpra; 
downshift_point a auto_dn_rpm • auto_dn_of fset_rpm; 

/* check that the calculated shift point is reasonable */ 
if (upshift_point > shf_tbl .man_dwn_sync_rp<n) 
upshi f t_point = shf_tbl .man_dvn_sync_rpra; 

if (downshift j»int < shf_tbl .man_up_sync_rpra) 
downshift_point = shf_tbl .raenjjp_sync_rpm; 

> 

#pragma 6JECT 



Funct ion: at I ect_g#*r 
Description: 

This is the root function for the periodic task SELECT_GEAR. Each 
loop begin* by checking the nenual up/doun buttons. Then, based on 
selected jaodt end output shaft speed, a 'get_. . ,_gear ' function is 
called to update destinat1on_g*ar_selected. 



void select gear(void) 
t 

char manual_request; /* current manual request (♦/- D */ 

static uchar enable_gcw_calc; /* diagnostic - delete later II*/ 

enable_gcw_calc = FALSE; /* diagnostic - delete later II*/ 

shf_tbl 3 ini_shf_tbl; /* initialize the shift table */ 

destination_gear_s elected * 1; 
desired_geer * ij 

/* initialize file scope variables */ 

w1 » 3; 
w2 « 4; 
w3 * 5; 
w4 s 6; 

lpf_output_speed = output_speed; 

upshift_point = shf_tbl ,autjjp_rpm; 
downshi f t_point = shf_tbl . aut_dwn_rpm; 
auto_up_offset_rpm = shf_tbl .up_t!roer_of f set_rpm; 
auto dn offset rpm = shf tbl.dwn timer offset rpcn; 
I owes t_forward"= INI T IAL~START_GEAR; 
automat ic^sip = 0; 
antihunt_counter ■ 255U; 
coasting latch * FALSE; 
flash_desired_allowed = TRUE; 

#if (0) /* shiftability variables */ 

zero speed counter = ZERO SPEED TIME LIMIT ♦ 5; /* force init of gcw variables */ 
eng_decel_rete = -400; 7* RPM?SEC */ 

TRANS_STEP_SIZE_CAL » 346; /* 1.352 BIM 8 (was constant) */ 

torque accessories = 100; /* accessory load with air condition off in coach */ 

gcw cal * 2400; /* (GCW x 1.68)/32.17 BIN 0 (was constant) V 

gcw"cal_new = 2400; /* (GCW x 1.68)/32.17 BIN 0 (was constant) */ 

gcw_local » 45000; 

gcw_local_counter » 50; 

gcw~locaOotal » 2250000; 

gross_cc<nbined_weight = 45000; 

#endif /* shiftability variables */ 

x start jjerfodicO; 

while (1) 

i 

mda_output_f ilterOi /* update our filtered output speed */ 

#if (0) /* shiftability */ 

if (enable gcv calc) /* diagnostic aid ! !*/ 
i 

deterrai ne_g r os s_c omb i ned_we i gh t ( ) ; 
deterrai ne~shi f tabi I i ty( )J 
determine'shiftability IK); 
> 7* shiftability */ 

fendif 

nanual_request = 0; 
deter»TneJ»se_8uto_sh i f t j>ts< ) ; 

/* set destination_gear_selected from function(s) appropriate for selected jnodt 

switch(selected ©ode) 

i 

case REVERSE M00E: 



case DRIVE M0OE: 



if Ufofwd last « TtUf> U 

<<fe«MTtjit*«y«* « FALSI) 1ft 
<low_spe«dJetcft « PALS)) 

C 

dest1nation_ge*r_Mttcted ■ get_automat i c_gear(des t i nat i on_gear selected, manual request) 
determine dest inat lon< ); 

) 

break; 

case LOU MODE: 

case HOLD NODE: 

case NEUTRAL NOOE: 

case PARK MOOE: 

case POWER UP MOOE: 

case POUER~DOUN KOOE: 

case DUCNOSTIcfTESTJttOE: 

/* prevent transient selection upon node change (these nodes ignore it) V 

destination_gear_selected » 0; 

break; 

default: 

/* invalid mode: do nothing */ 
break; 

> 

x sync^per iodic (US PER LOOP); 

> 

x_end_per i odi c ( ) ; 



Unpublished and confidential. Hot to be reproduced, 
disseminated, trenef erred or used without the prior 
written consent of Eaton Corporation. 

Copyright Eaton Corporation, 1994. 
All rights reserved. 



* Filename: trns_act.c96 (R-747) (AutoSplit) 

* Description: 

* This modules monitors and controls the transmission's actions. 

* Part Number: <none> 
• 

* Rev 1.5 12 Dec 1994 09:19 markyvech 

* In "determine^gear" function; added condition for "intentjiold" and 

* *in_gear switch". 

* ™ ™ 

* Rev 1.4 9 Dec 1994 14:25 markyvech 

* In u determine_gear" function; added conditions that the u gear_in_timer M 

* will be held high while in the eng i ne_sync_mode and the intent_to_shif t 

* switch is depressed. (A smaller sync error is maintained for easier 

* lever engagement when the switch is depressed.) Also changed the offset 

* for clearing the low_speed_latch from downshi f t_point ♦ 100 to 

* downshi ft jjoint ♦ 275. 
* 

* Rev 1.3 9 Dec 1994 07:59 markyvech 

* In "determine_spl i tter_state_autospl i t" function; added the conditions 

* to preselect the splitter if~the M intent_to_shi f t_swi ten" is TRUE. 

* — — — 

* Rev 1.2 7 Dec 1994 15:53 markyvech 

* Added the "determine^ange^state 1 * function. Set the appropriate range 

* solenoid select flag based on the electric range select switch. 
* 

* Rev 1.1 5 Dec 1994 14:54 markyvech 

* Broke the "determine_spl itter_state M function into multiple functions 

* based on the type of base transmission system we are working with. 
* 

* Rev 1.0 3 May 1994 13:35:04 markyvech 

* Initial revision. 
* 

♦♦♦★★★★★A***************************************************************/ 

* 

* Header files included. 



# include 
^include 

# include 
#include 
#include 
#include 

# include 
#include 
finclude 
# include 
#include 

# include 
finclude 



<exec.h> 
<c_regs.h> 
<kr sfr.h> 
<kr~def.h> 
<wwslib.h> 
"drl cmds.h" 
»trns_act.h u 
"trn tbl.h" 
u calc_spd.h« 
"cont'ays.h* 
"sel gear.h" 
»conJl939.h» 
u pr s i s.h" 



/* executive information */ 

/* KR internal register definitions */ 

/* defines the kr special function registers V 

/* 80c196kr bits, constants, and structures V 

/* engine control interface */ 
/*- interface to this module V 
/* transmission table */ 



* Variables declared by this file. 
* 



register unsigned char transmission_position; 



unsigned char 
unsigned char 
unsigned char 
unsigned char 
unsigned char 



R747_type; 

j ammed_ i n_wrong_gear_t i me r r 
manua I ~sync_de I ayed_t i mer ; 
low_speeoMatch; 
forward^last; 



unsigned ch*r 
unsigned char 
unsigned char 
unsigned char 
unsigned char 
unsigned char 
unsigned char 
unsigned char 
signed char 
signed char 
signed char 
unsigned int 
unsigned int 
unsigned int 
unsigned int 
unsigned int 
signed int 
signed int 
signed int 
signed int 
signed int 
signed long 
signed long 
signed char 



spiltterjil; 

tpUtter_lo; 

rangO*; 

range'lo; 

spUtttr_ti«er; 

spl i tttr_w i thin_sync; 

aux_box; 

downsh i f t_de I ayed; 

g_ptr_old; 

current_gear; 

lastjcnown^gaar; 

gear~in_tiner; 

gearjxjt_timer; 

no rma I _au t o_neu t ra I _t i me r 

abs_trans_sync_error; 

t r ans_w i ndow_ca I c ; 

i nput_speed jnod i f i ed; 

trans_sync_error; 

range_error; 

rangt_cal; 

splitter_tc; 

isdgf; 

gros; 

gj)tr; 



#pragma EJECT 



• ffeflnts and constants local to this file. 



#def ine US*P€R I 


.OOP 


100O0U 














#define JAMMED J 


IMS 


200 


/* 2.0 SECONDS */ 










static const 


uct 


»ar SPLITTER_LO_TABLE[23] « 
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*/ 


/* 
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3 
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V 
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/* 
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*/ 


/* 
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split_hi 


3 
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direct 


V 
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/* 


1 0 


*/ 


/* 


split_lo * ON, 
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3 
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direct 


V 
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r 1 


*/ 


/* 


split'lo ■ ON, 


spl i t_hi 


3 
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V 
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/* 


r 2 


*/ 


/* 


split_lo ■ OFF, 
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3 


ON; 
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V 
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' 3 


*/ 


/* 
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* 
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V 
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V 


/* 
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3 
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V 
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/* 


* 5 


•/ 


/* 
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3 
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V 
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/< 
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V 


/* 
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spl i t_hi 


3 


ON; 


overdrive 


V 
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/< 
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*/ 


/* 
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split'hi 


3 


OFF; 


direct 


V 
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r 
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V 


/* 


split lo a OFF, 


split hi 


3 
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*/ 
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/< 
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V 


/* 
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3 
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V 
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r 
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V 
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splitjii 
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o. 
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>; 

static const 
C 

o, 
o. 

ON, 
OFF, 
OFF, 
OFF, 
ON, 
OFF, 
ON, 
OFF, 
ON, 
OFF, 
ON, 
OFF, 
ON, 
0, 
0, 
0, 
0, 
0, 
0, 

o, 

0 

>; 



ar SPLITTER HI TABLE [233 * 
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#pragma EJECT 



static const vxhar SPl I TTW_TC_T«u \Z5l » 
< /* Spilttar 
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>; 



#pragma EJECT 



* Function: Initialf ze_Trans_Action 

* Description: 

* This function initializes those nodule variables that must be set to a 

* know state on power <-p or reset. 

************************************************************************** 

void initialize trans act ion< void) 
( 

gear_in_timer a 500; 
gear~out_ timer » 500; 
g_ptr_old * 0; 
current_gear » 0; 
last_known_geer = 0; 
destTnation_gear ■ 0; 
transmission_position » OUT_OF_GEAR; 
low_speed_latch = TRUE; 
splitter_To 9 0; 
splitter'hi => 0; 
range_lo~» 0; 
range Jii » 0; 

normal auto neutral timer * 0; 
downshift. delayed »~FALSE; 
manua I _sync_de I ayed_t i mer * 0; 
jammed'in wrong gear timer » JAMMED TIME; 
R747 type~« INTENT; ~ 

> 

#pragma EJECT 



* Function: ChecJt_For_Jamsed_Gear 

* — — 

* Description: 

* This function checks for a indicated engaged gear, <g_ptr), that is different 

* than "destination^geer^setected 1 * and will force the needed conditions to 

* recover. This condition can occur when the transmission is jammed** into 

* the wrong lever position, (usually with the clutch disengaged), during a 

* shift, 
* 

void check_for_jammed_gear(void) 



if (<shift_in_process == TRUE) && 
(automat ic_sip 1= 0) && 
(destination_gea reelected != g_ptr) && 
(gj>tr !» 0)~tt 

( jammed_in_wrong_gear_timer > 0)) 
j anmed_ i n_wr ong_gea r_t i iner - - ; 

if (jammed in wrong gear timer == 0) 
< 

shift_in_process = FALSE; 
automat ic_sip = 0; 
desired_gear = current_gear; 
destination_gear = current_gear; 
destination_gea reelected = current_gear; 
jammed in_urong_gear_ timer = JAMMED_TIME; 
engine~canmands"= ENGINE RECOVERY; 

> 



#pragma EJECT 



Function: determine_9«ar 
Description: 

This function determines tht current gear that the transmission 
is in. When conditions art such that the current gear can not be 
determined it will be set to a default, (0). 

Note: When the error across the transmission is near zero for some 
time for a given test gear then it will be deemed in that gear. 

trans_sync_error = input_spd/gf [gear] - grCgear] * oa 



void determine gear (void) 



#define BIN 8 


256 > 


'* 2 BIM 8 */ 




#define MAX~ERR 


4000 > 


'* RPM */ 




#define WINDOW 


30 / 


'* 30 RPM */ 




#define GEAR IN TIME LEVER 


125 > 


'* 250 MSEC a 5 cnts per loop 


V 


#define GEAR~IN~TIME~AUTO 


50 > 


100 MSEC a 5 cnts per loop 


*/ 


#define GEAR~0UT TIME 


8 > 


'* 80 MSEC */ 




#define MANUAL SYNC DELAYED TIME 


45 > 


'* 450 MSEC V 




#define ERROR FUDGE~FACTOR " 


3 > 


'* RPM V 




#define NORMAL_AUTO~TIME 


250 > 


'* 2.5 SEC */ 




#if (0) 









g_ptr = -1; /* lowest reverse ratio */ 

/** isdgf = i nput_speed_f i I tered / front box gear ratio **/ 
_bx « (signed int)( input~speed filtered); 
~cx » BIN_8; 

~ax a trn~tbl.GF[g_ptr ♦ GR_OFS]; 
asm mul _cxdx, _bx; 
asm div _cxdx, _ax; 
isdgf = ~cx; 

/** gros = output speed filtered * rear box ratio **/ 

_bx a (signed int)(output_speed_f i.ltered ♦ ERR0R_FUDGE_FACTQR); 

"cx = trn tbl.GRtgj)tr ♦ GR OFsT; 

~ax = BIN~8; 

asm mul _cxdx, _bx; 

asm div "cxdx, ~ax; 

gros = _cx; 

trans_sync_error = (isdgf - gros); 
if (isdgf > gros) 

abs_trans_sync_error a (unsigned int)( isdgf - gros); 
else 

abs trans sync error = (unsigned intKgros - isdgf); 

#endif 



abs_trans_sync_error a MAX_ERR; 
t r ans_w i ndow_ca I c = 0; ~ 

if (abs trans sync error > trans window calc) /* if not in reverse, check for forward V 

i 

g_pt£ 3 1 ♦ trn_tbt7highest_forward; 
abs^Trans_sync_errQr « KAX_ERR; 

while ( ( eba_t r ens^a/nc^tr ror > trans_window_calc) && (gj>tr !» 0)) 



gj>tr--; 

/** isdgf = input_speed_f iltered / front box gear ratio **/ 
_bx a (signed int)0*nput_speed_f i I tered); 
jrx a BIN_8; 

~ax * trn~tbl.GF[g_ptr ♦ GR_0FS]; 
asm mul _cxdx, _bx; ~ 
asm div _cxdx, _ax; 
isdgf » _cx; 

/** gros a output speed filtered * rear box ratio **/ 

_bx » (signed int)(output_speed_f i Itered ♦ ERR0R_FU0GE_FACT0R ) ; 

cx a trn tbl.GRCgjJtr ♦ GR 0FS3; 
"ax a BIM~8; 
asm mul _cxdx, _bx; 
asm div _cxdx, _ax; 
gros » _cx; 



trans rync_error « Isdgf - grot; 
if (iidgf > gro»> 

abs_trens_SYnc_error a (int)( isdgf - gros); 
else " 

abs_trans_sync_error « (intXgros - isdgf); 
/* calculate trans sync error window based on gear pointer */ 



bx * WINDOW; 


/* 


SIM 0 */ 


~cx » BIN_8; 


/* 


8IH 8 V 


~ax « trn~tbl.GF[g_ptr ♦ 6ft_0FSl; 


/* 


BIN 8 */ 


asm raulu "cxdx, Jw; 


/* 


make WINDOW BIN 8 V 


asm divu _cxdx, _ax; 


/* 


divide by front ration BIN 8 */ 


trans_window_calc » _cx; 


/* 


BIN 0 */ 



if (g_ptr *= 0) /* If in neutral , force values V 

< 

abs_trans_sync_error = MAX_ERR; 
trans_sync_error * MAX_ERR; 
trans~window_calc = 0;" 
isdgf ■ 0; 
gros 3 0; 

downshift_de laved » FALSE; 

jammed in'wrong gear timer * JAMMED TIME; /* Initialize for next occurence */ 

> 

if ((aba_trans_sync_error > trans_window_calc) || /* Must have error for some */ 
(<9_ptr 1* current_gear) && (current_gear != 0))) /* before neutral state is */ 

< /* recognized. */ 

if (gear out timer == 0) 
< 

transmissi on-position = 0UTJ5F_GEAR; 
current gear = 0; 

> 

else 

gear out timer--; 

> 

else 

gear_out_timer s GEAR_OUT_TIME; 



if Ug_ptr 1= gjrtrjsld) || (g_ptr == 0) || 

((intent_to_shift_switch == TRUE) && 
(in gear switch » FALSE) && 
(engine cocrroands == ENGINE SYNC) && 
(shift_7nit_type == MANUAL)) || 

((acceleratorjsedal^position < 5) && 
(input speed < 700) U 
(low speed latch =- FALSE))) 

< 

if ((engine commands == ENGINE SYNC) || 
(engine'eoonands » ENGINE~PftEDlP)) 

( 

if (engine coonends «» ENGINE PftEDIP) 
< 

normal_auto_neutral_tiaer ■ 0? 
manua I Isync~de I ayed^t i rse r * 0; 



else 

if (r»rtnal_auto_neutral_tiner <* NORMAL_AUTO_TIME) 
nonnal_auto_neutral_t imer*>; 

if ((shift init_type =* AUTO) && 

(nonnaT_autSneutral_tiraer < NORMAL_AUTO_T I ME ) ) 
geer_in_tTtner = GE AR_ I N_T I ME_AUTO ; 
else 

geerjn_timer = GEAR_I N_T I KE_LE VER ; 



/* intent to shift stuff */ 



/* if not in gear, init gear in timer. */ 

/* Rule out picking a gear when coasting */ 

/* down in neutral and no throttle. */ 

/* (Found that idle speed and output speed •/ 

/* would match a gear even when in neutral.) V 

/* Note: 700 should be idle+100RPN V 



/* Use a short in gear time V 

/* for splitter only shifts */ 

/* unless the system has been V 

/* in neutral too long. */ 

/* EX: When driver pulls the */ 

/* lever to neutral during a */ 

/* splitter only shift. V 



else 

if (gear in timer »= 0) 
current "ear * a otr* 



last kromj&mr ■ gLP^? 
trsnsarission.positlcrt » HJWt; 

normal auto neutr»l_tis»r ■ 0; /* get ready for next tiat V 
downthTft.delayed • FALSE; 

if ((intent_to_shift_s«ltch «i TRUE) && (engine_caimands « ENGINE_SYNC)) 
intentJ\oTd ■ TRUE; 

if ((gos current gear > (downshif tjsoint ♦ 275)) && 
(low~spe«d latch « TRUE)) 

{ 

low_speed_latch » FALSE; 
destination^gear ■ current_gear; 
destination~gear_selected « current_gear; 
desired_gear * current_gear; 
lowest forward 3 current gear; 

> 

else 

if (low speed latch « TRUE) 
( 

destination_gear = lowest_forvard; /* was set to 1 */ 

destination~gear_selected~« lowest_forward; /* was set to 1 V 
desired_gear = lowest_forward; " /* was set to 1 */ 

shift in^process * FALSE; 

> 



if (last known gear > 0) /* Record REV/ FOR data for */ 

forward last"* TRUE; /* use in the select_gear */ 

else " /* module. V 

forward last = FALSE; 

> 

else 

t 

if ((((shift init type == AUTO) || (low speed latch == TRUE) || 
(manual_sync_delayed_timer >= HANUAL_SYNC_DELAYED_T I ME ) ) ) && 
(gear_in_ timer >= 4)) 
gear_in~timer -= 4; 

if (gear_in_timer > 0) 
gear_Tn_t imer- - ; 

if (destination_gear_selected == gj>tr) /* Prevent splitter shift while */ 
downshift_delayed * TRUE; /* still confirming a lever shift. */ 



> 



check_f or_jammed_gear( ); 
g_ptr_old = g_ptr ; 

if (((engine commands == ENGINE SYNC) || 

(engine'eonvnands » ENGINE FOLLOWER)) && 
(manual,sync_delayed_timer < HAHUAL_SYNCJ)ELAYED_T IME ) ) 
manua I _sync_de!ayed_t i raer++ ; 



/* manual sync_delayed_timer is used to allow the sync 
/* mode's~first pass a~chance to pass the engine speed 
/* thru sync and give the mechanicals a chance to 
/* transition. At this tine a false in_gear signal 
/* should be avoided. V 



if (output speed filtered < 125> /* If stopped; set low speed latch */ 

{ 

current_gear s 0 ; 

transmissi on-position » 0UT_0*_GEAIt; 
lo«_speeoMatch * TRUE; 

if (splitter launch state =- LO SPLITTER) 

i 

if (( lowest jforward « 2) II 
(lowest^forward « 4) || 
(lowest~forward 6)) 
lowest forward—; 

> 

else 

i 

if ((lowest_forward « 1) II 
(lowesOorward « 3) || 
(lowest'forward ■« 5)) 
I owest_f orwerd*» ; 



E&CT 




* Function: detenqine_range_8tatus 

* Description: , 

* This function determines the status the of range. 

* rng_err = rear_counter_spd - (range_ratio * output_spd) 

* ™ — "~ ™ ~" 

* res 3 54/21 * 44 * os (for low range) 
* 

* res a 42/51 * 44 * os (for high range) 
* 

void determine range status(void) 
i 



#define BINJ2 


4096 


/* 


2 bin 12 


V 


#define HI RANGE GEAR 


7 








#define LO~RANGE~CAL 


10532 


/* 


54/21 BIN 


12 */ 


#define hTrange'cal 


3373 


/* 


42/51 BIN 


12 V 


#define RANGEJJINDOU_POS 


30 


/* 


30 RPM 


V 


#def ine RAN GE~U t N0OW~H EG 


-30 


/* 


-30 RPM 


V 



/*** This code was never tested or used during the concept development ***/ 
/*** phase. However, it is likely to be needed for range protection ***/ 
/*** in the product. ***/ 



if (destination gear >= HI RANGE_GEAR) 

range_cal = H7_RANGEj:Al7 
else 

range_cal = 10_RANGE_CAL; 

range_error =( ( (aux_speed * BIN_12) 

- <range_cal * output_speed_f i ltered))/BINJ2); 

if ((range error > RANGE WINDOW POS) || (range_error < RANGE_UIkOOW_NEG) ) 

aux_box = OUT_OF_GEAR;~ 
else 

aux_box = IN_GEAR; 

> 



#pragma EJECT 



* Function: detenaint_range_atate 

* ~" 

* Description: 

* This function determines the correct state for the range. 
* 

void determine range state(void) 



if (range select switch « HIGH) 
C 

range_lo = OFF; 
range'hi * ON; 

> 

else 
< 

range_lo = ON; 
range hi = OFF; 

> 



/* Turn off the low range solenoid */ 
/* Turn on the high range solenoid */ 



/* Turn on the low range solenoid */ 
/* Turn off the high range solenoid */ 



tfpragma EJECT 



* Fine t ion: determfr»_splitter_state autosplit 

* "* 

* Description: 

* This faction determines the correct state for the splitter. 

* Once the transmission is in gear both splitter solenoids are turned off. 
* 

void determine splitter state autosplit(void) 
< 

#define SPUR SYNC OFFSET POS 80 /* 80 RPM */ 
#define SPLTR SYNC OFFSET NEG -80 /* -80 RPM V 
idefine SPLITTER tTmE " 20 /* 200 MSEC */ 



if (engine_status == ENGINE PREDIP MOOE) /* The splitter timer will keep the V 
splitter_timer * SPLITTER_TIME; /* solenoids on'for a short time */ 

else /* once the SYNC mode is entered. */ 

if (splitter_timer > 0) /* This allows the splitter enough */ 

splitter_t7raer--; /* time to move, (i.e., whan the */ 

/* splitter changes during SYNC. */ 

splitter_tc = SPL I TTER_TC_TABLE [dest i nat ion_gear ♦ GRJDFS] ; 

input_speedjnodif ied = (signed int)( input_speed_f i Itered) ♦ 

( input_speed_accel_f i Iter ed/( 1000/ split ter_tc )); 

if ((input speed modified < (gos signed + SPLTR SYNC OFFSET POS)) && 
(inputjspeedjnodif ied > (gos^signed ♦ SPLTR~SYNC~OFFSET~NEG))) 
splitter_within_sync * TRUE; 
else 

splitter_within_sync 3 FALSE; 

if ((intent_to_shift_switch « TRUE) && /* Allows for pre-selection * 

(desired gear (^destination gear selected) && /* of the splitter. 

( intent Jiold == FALSE) && 
(automatic sip 0) && 
(shift_init_type == MANUAL ) && 
( transmission jx»si t ion == IN GEAR)) 

( 

splitterjii = SPL I T TER JU _T AB LE tdesired_gear + GR_0FS); 
splitter~Lo = SPLITTER~L0~TABLE Cdesi reoTgear ♦ GR~0FS]; 



else /* "Normal" splitter control V 

i 

if ((splitter_timer > 0) | | 

((transmission_posi tion IN_GEAR) && 
(shift_in_j)rocess == FALSE)) || 

(low_speedJatch « TRUE) || 

(engine_status » ENG I NE J* ECOVEAYJWOE) || 

((shift init type » MANUAL) U 
(engine.statua « ENGINE.SYNCMCDE)) || 



((shift init type » AUTO) U 
(engine status « ENGINE SYNC MOOE) U 
(splitter_within_sync «»"TWE))) 

splitter hi = SPLITTER HI TABLE [destination gear ♦ GR OFS]; 
splitterjo = SPL I TTER ~LO~TABLE Cdest i nat i on][gear ♦ GRJ)FS); 



else 
< 

splitterju = OFF; 
splitter"lo » OFF; 

> 

> 

> 

fpraojna EJECT 



* Function: deterafne_splitter_state_dual_force 

* ~" ~" 

* Description* 

* This function determine* the correct state for the splitter. 
* 

void determine splitter state dual force(void) 
( 

if <<clutch_state == DISENGAGED) || /* use normal forces */ 

(desired gear > 6)) 

C 

splitter_lo = ON; 

> 

else 

C 

if (splitter_select_switch == HIGH) /* use high force into overdrive 

splitter_lo * OFF; 
else 

splitter lo * OH; 

> 

if <splitter_select_switch == HIGH) 

splitter_hi = ON; 
else 

splitterjii = OFF; 



#pragma EJECT 



* function: deter»ine_splitter_state_base 

* Description: 

* This function determines the correct state for the splitter. 
* 

void determine splitter state base(void) 
< 

splitter_lo = ON; 

if <splitter_setect_switch == HIGH) 

sptitterjil = ON;" 
else 

splitterjii * OFF; 

> 

ipragma EJECT 



* Function: determine.spl i tter_state 

* Description: 

* This function determines the correct state for the splitter. 
* 

void determine splitter state(void) 
< 

if <R747_type =* BASE) 
detennine_spl i t ter_state_base< ); 

else 

if (R747_type « DUAL_FORCE) 
de t erroi ne_sp I i t t e r_s t a t e_dua I _f ore e< ) ; 

else 

determine splitter state autosplitO; 

> 



#pragma EJECT 



****** 

Funct f on: T r ansai ss i on Act i on 



Description: 

This function controls the states of the system ouput devices. 



******************************** 

void transmission act ion( void) 
{ 

initialize trans actionO; 



/* initialize variables */ 



x start_periodic(); 

while (1) 

€ 

det e rra i ne_gea r ( ) ; 
determi ne~range_status( ) ; 
deterrai ne_range_state( ) ; 
determi ne~spl i tter_state< ); 

x_sync _periodic(US.PER_LOOP); 



/* calculate the current gear */ 

/* determine range state */ 

/* determine correct state for range */ 

/* determine correct state for splitter V 



x_end_peri od i c ( ) ; 



.J 



\ f 
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Unpublished and confidential. Mot to be reproduced, 
disseminated, transferred or used without the prior 
written consent of Eaton Corporation. 

Copyright Eaton Corporation, 1993-94. 
All rights reserved. 

Filename: drl_cmds.c96 (R-747) (AutoSplit) 
Description: 

The functions in this file will per font the required operations 

for controlling drivel ine components on the J 1939 communication link. 

Part Number: <none> 

Rev 1.4 09 Dec 1994 14:29 markyvech 
In function "control.engine^sync"; added code to allow smaller sync 
offsets if the intent to shift switch is depressed. This allows easier 
shift lever insertion. (Note: the gear cannot be confirmed until the 
switch is released.) 

Rev 1.3 09 Dec 1994 11:18 markyvech 
In function "control^engine^predip*'; added code to allow recovery mode if 
the intent switch is released before neutral is achieved. Also added the 
pr_s_i_s.h to get the intent_to_shift_swi tch variable. Also added a faster 
torque ramp off rate for manual intent to shifts 

Rev 1.2 08 Dec 1994 14:44 markyvech 
Changed the offsets in ,, control_engine_sync' 1 from +-65 to +-45 RPM. Also 
changed the input speed filter constant, (I$_FK1) ( from 236 to 235. 

Rev 1.1 07 Dec 1994 15:33 markyvech 
Took out the rear counter shaft speed substitution for output shaft speed 
because there is no rear counter shaft speed sensor. 

Rev 1.0 14 Sep 1994 10:48:40 markyvech 
Initial revision. 



y************************************************************************ 
* 

* Header files included. 

************************************************************************/ 



^include 
# include 
#include 
#include 
# include 
#include 
#include 
^include 
^include 
#include 
# include 



<exec.h> 
<c_regs.h> 
<wwslib.h> 
"cont sys.h u 
"con j 1939. h» 
"drl cmds.h» 
"trn tbl.h" 
"sergear.h* 
"calc spd.h" 
»trns_act.h- 
"pr_s_i_s.h* 



/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 



executive information */ 

ICR internal register definitions */ 

contains common global defines V 

control system information V 

defines interface to j 1939 control module */ 

drivel ine commands information */ 

transmission table data structures V 

access to speed filter values */ 



#pragma noreentrant 



* #defines local to this file. 
* 

****************************** 



#define USJ>ERJ.OOP 10000U 

#define ACT I VE_RECOVERY_GEAR 10 /* rule out boosting downs for now */ 



* Constants and variables declared by this file. 



/* public */ 



register unsigned char enoine^caowndi; 
register unsigned char engi nonstatus; 



unsigned char deaired_sync_testjB 

unsigned char forced_prtdip; 

unsigned int desired_engine_speed_te*t; 

unsigned int Q^sired_engine_speeof rasp; 

unsigned char desired~engine~speeoTtimer; 

unsigned char desired_engine_speed_time; 

unsigned char eng_brake_coninand; 

unsigned char eng_brake~assist; 

unsigned char posit ive_pedaL tran8 ** 

unsigned char sync_f irst_pass_titner; 

/* unsigned char cTutch_state; */ 

unsigned int clutches I 7p_speed; 

signed int dos_f iltered; 

signed int overall_error; 

unsigned int os_based_on_rcs; 

unsigned int input_ipeed~fi I teredo- 
si gned int dgos;~ 

signed int input_speed_accel_f i Itered; 

unsigned int output_speed_f i I tired; 

unsigned long is_f i I tered_bin8; 

unsigned long os^f i ltered~bin8; 

signed long dis_f i I tered_bin8; 

signed char eng_percent_torque_fi Itered; 

signed char percent_torque_accessories; 

signed char needed_percent_for_zero_f lywheel_trq; 

unsigned char zero_f lywheel_trq_t imerj 

unsigned char zero_f lyvheel_trq_time; 

unsigned char acceTerator_pedal _posi tion_old; 

unsigned int gos; /* overall destination gear ratio * output speed BIN 0 */ 

signed int gos_signed; /* overall destination gear ratio * output speed BIN 0 */ 

signed int input_shaf t_accel_calculated; 

unsigned int gos_current_gear; /* overall current gear ratio * output speed BIN 0 */ 

unsigned char sync_f irst_pass; 

unsigned int syncjnaintain_timer; 

signed int sync_offset; 

signed int sync~of fset_pos; 

signed int sync_of fset_neg; 

signed int sync~dos_offset; 

signed int sync_dos_off setjO; 

signed int sync_speed - modified; 



/* local */ 




static 


unsigned 


int 


static 


unsigned 


char 


static 


unsigned 


char 


static 


signed 


char 


static 


unsigned 


char 


static 


unsigned 


int 


static 


unsigned 


int 


static 


unsigned 


char 


static 


unsigned 


int 


static 


unsigned 


char 


static 


unsigned 


int 


static 


unsigned 


int 


static 


signed 


int 



predip_timer_1; 

predip~ti«er~2; 

predlp^ttner^; 

prtdl pTtorquibLnp_va lue; 

pred1p_torqu*~bunp~t ine; 



torque_lfait; 
recovery_cancal_timer; 
recov_coast_down_t!np1 ; 
r ecov~coas t~down~tmp2 ; 



Ipf _output_accel ; 



8ync_on^tintr; 
syncjjf7_tiaar; 
synced i ther_t i«tr; 



ipragma EJECT 



PREDIP MODE CONSTANTS 



idef ine 


PREDiP ZERO FD8K TIME 


40 


/* 


0.408 9 10ms period 


idefine 


PREOtP~ToaeGs zcio tike 


60 


/* 


0.60s 31 Ota period 


idefine 


predip~normal~ti«~ 


200 


/* 


2.00s aiOos period 


idefine 


TOWUE~RAW.OFr.RATE 


1 


/* 


1X (per loop) V 


idefine 


PREDIP TORQ BUMP VALUE LO 


0 


/• 


OX */ 


idefine 


PRED I P_TQRO~BUW>J I ME_LO 


15 


/• 


0.15s 910bs period 


idefine 


PREDIPJTORQ BUMP VALUE MED 


10 


/* 


10% */ 


idefine 


preoip.toro"bump~time.med 


25 


/* 


0.25s aiOkns period 


idefine 


PREDIP TORQ BUMP VALUE HI 


25 


/* 


25X V 


idefine 


PRED I P_T0R0~BUMPJ I ME_H I 


30 


/* 


0.30s ai0o6 period 



V 

V 



SYNC HOOE CONSTANTS 



idefine 


SYNC DITHER TIME ABOVE 


20 


/* 


0.20s 3 10ms period 


•/ 


idefine 


SYNC DITHER~TIME~BELOU 


30 


/* 


0.30s a 10ms period 


*/ 


idefine 


SYNC DITHER~RPM ~ 


35 


/* 


35 rpra 


V 


idefine 


sync_dither"first_time 


255 


/* 


DUMMY VALUE 


V 


idefine 


MAINTAIN SYNC TIME 


500 


/* 


5.00 Sec 


*/ 


idefine 


SYNC FIRST PASS TIME 


250 


/* 


2.50 Sec 


V 


idefine 


THREE PERCENT 


3 








idefine 


ENG_RESPONSEJJPSHF TIME 


10 


/* 


10 msec 


*/ 


idefine 


eng~response"dnshf~time 


10 


/* 


10 msec 


V 


idefine 


SYNC DOS OFFSET CONSTANT 


2816 


/* 


11 BIN 8 


*/ 



RECOVERY MODE CONSTANTS 



idefine RECOVERY CANCEL TIME 10 

idefine R E COVE RY~CANCEL~OFF SET 20 

idefine RECOVERY T0R0UE~STEP 1280 

idefine THLO OS ENG DECAY K1 450 

idefine THL0~0S~ENG~DECAY~RAMP 1 

idefine THLO~DS"finTshED DELTA 200 



static const 
t 



uint RE COVE RY_RATE_T ABLE [23] = 





/* 


-4 V 










o. 


/* 


-3 V 












/* 


-2 : 0.5OX 




loop 


BIN 8 


*/ 


128, 


/* 


-1 : 0.50% 


P*r 


loop 


Bin 


V 


128, 


/* 


0 : 0.50ft 


9** 


loop 


•IN 8 


V 


128. 


/* 


1 : 0.50% 


P«r 


loop 


81H 8 


V 


128, 


/* 


2 : 0.5OX 


P«* 


loop 


BIN t 


V 


128, 


/* 


3 : 0.50* 


Ptr 


loop 


tin 8 


V 


128, 


/* 


4 : 0.50% 




loop 
loop 


BIN 8 


V 


192, 


/* 


5 : 0.75% 




BIN 8 


V 


1°2, 


/• 


6 : 0.75X 


P«r 


loop 


BIN 8 


V 


192, 


/* 


7 : 0.75X 


per 


loop 


BIN 8 


V 


281, 


/* 


8 : 1.10* 


per 


loop 


BIN 8 


V 


281, 


/* 


9 : 1.10X 


P*r 


loop 


BIN 8 


V 


281, 


/• 


10 : 1.10% 


per 


loop 


BIN 8 


V 


o, 


/* 


11 V 










o, 


/* 


12 V 










o. 


/* 


13 V 










o, 
o. 


/* 
/* 


14 V 

15 V 










o, 


/* 


16 V 










o. 


/* 


17 V 










0 


/• 


18 V 











/* 0.10s a 10ms period */ 
/* 20% BIN 0 */ 
/* 5X BIN 8 V 



/* 1 rpra BIN 0 */ 
/* 200 rpn 8IN 0 V 



>; 



* Function* inftiaUae_driveline_ofcta) 
• 

* Description: 

* This function, called after all resets, will initialize the system 

* copy of drivel ine related data received froro the ccmnuni cat ions link. 
« 



static void initialize drivel ine data(void) 

i 

accelerator_pedal_position * 0; 
engine_camunication_active « FALSE; 
engine~brake_ava liable ■ FALSE; 

eng brake_coanand * ENG_8RAKE_IDLE; /* should init with engine c 
/* cTutch_state * ENGAGED; V " 
posit ive_pedal_trans » FALSE; 
zero_f lywheel_trq_timer » 0; 
zero~f lywheel_trq_time ■ 0; 
percent_torque_accessories » 3; 



desired_sync_test_mode = FALSE; 
desired_engine_speed - test 3 0 ; 
desired~engine~speecf raop 3 0 ; 
desired_engine~speed_timer = 0; 
desired~engine"speed"» 0; 
sync_dos_offset_K1 = SYMC_DOSJDFFSETj:QNSTAMT; 
desired_engine_speed_time * 0; 
forcedJJredip = FALSE; 



/* debug use only 
/* debug use only 
/* debug use only 
/* debug use only 



delete later */ 

delete later V 

delete later */ 

delete later */ 



#pragma EJECT 



function: control _engine _predip 



* Description: 

* Determines throttlt command for predip mode. 

* After a reasonable delay for the transmission to pull to neutral the 

* torque will be cycled from zero to a determined value to help the 

* transmission achieve neutral. 

static void control engine_predip<void) 
< 

if (engine status I- ENGINE PREDIP MODE) 

engine_status * ENG I NE_PRED IP_M00E ; 

predip_timer_1 * 0; 
pr edip~timer~2 « 0; 
predip_timer_3 » 0; 

if ((actual engine_pct trq < 5) | | (forced_predip timer > 0)) 

predip_t7merj * PRED I P_NORMAL_T I ME ; 
else 

desired engine_pct trq * actual engine j*t trq; 

> 

engine control = TORQUE CONTROL; 
command_ETC1 = C_ETC1_OVER$PEED; 



if ((intent_to_shift_switch sa TRUE)) /* Allows for recovery mode if the "intent" switch V 
posi tive_pedal_trans » TRUE; /* is released before neutral is achieved */ 



if (predip timer 1 < PREOIP NORMAL TIME) 
( 

if ((desired_engine_pct_trq >« TORQUE_RAMP_OFF_RATE) && 
(actual engine_pct trq > 0)) 

( 

desired_engine_pct_trq -=» TGRQUE_RAMP_OF F_RATE ; 

if ((intent to shift switch » TRUE) U /* faster rate for intent to shift V 
<shiftjnit_type~« MANUAL) && 
(actuaT_engTne jxt_trq > 0)) 
desired enginejxt trq -« 1; 

> 

else 
< 

desired_engine jxt_trq =» 0; 

/* check to force bump if neutral not achieved */ 

if (actual engine _pct trq < 10) 

( 

if (♦♦predip timer 3 >« PREDIP ZERO F0WC TIME) 
predip tiaWr 1 • PREOIP NORMAL nME; 

> 

> 

♦♦predip timer 1; 

> 

else 
< 

if (((Ipf output accel > -150) || (forced_predip timer > 0)) && 

(predip timer'l < (PREOIP NORMAL TIME ♦ PREDIP TORQUE ZERO TIME))) 

{ 

predip_torque_bump_tirae ■ PREDIP TORQ_BUMP_T I KE_LO; 

predip~torque~bump~value * PREDIP TORQ BUMP VALUE LO ♦ needed ^percent for zero flywheel trq; 
> - - - - 

else 
< 

if (predip timer 1 < (PREDIP NORMAL TIME ♦ 2*PREDIP TORQUE ZERO TIME)) 
{ 

predip_torque_bump_time = PR ED I P_TORO_BUMP_T I ME J4ED ; 

predip~torque~bump~value » PREDIP TORQ BUMP VALUE MED ♦ needed ^percent for zero_f lywheel trq; 

} 

else 

{ 



pr«dIp_torq(Jt.bU9>_ttaft • PtOIP.TOBO.BUMP TIME HI; 

pr*dfp_torqj*>flp i _v»lu» ■ PfcED I P_TatO_BUNP_VALUE_H 1 ♦ needtd_p»rctn*_for_z»ro_f lyubt«l_trq; 

> 

if (predfp tiaer 2 < prtdtp torque bunp time) 
t 

des i red_eng i ne _pct_t rq ■ prtd i p_torque_bciTp_va I ue ; 

if (actual engin#_pct trq > 0) ~ 

< 

♦♦pred i p_t i mer_1 ; 
♦♦predip timer 2; 

> 

> 

else 

C 

desired_engine _pct_trq 3 0; 
♦♦predip_timer_1; 
♦♦predip timer~2; 

> 

if <predip_tiroer_2 >= PREDIP_TOROUE_ZERO_TIME> 
predip timer 2*0; ~ ~ 

> 

> 

#pragma EJECT 



* Function: c ont ro t _eng i ne_t ync (AutoSplit) 

* Description: 

* This function synchronizes engine speed to output shaft speed 

* during a shift. 

static void control engine sync(void) 
C 

if ((intent_to_shift_switch « TRUE) U /* Intent to shift conditions */ 
(shift Tnit type~« MANUAL)) /* that allow lower offsets. */ 

< 

sync_off8et_poa ■ 20; 
sync""offset neg « -20; 

> 

else 
t 

sync_offset_po8 * 45; /* normal AutoSplit offsets V 

sync~offset neg ■ -45; 

> 

if (acceleratorj5edal_position > THREE PERCENT) 
syncjnaintain_timer = MAINTAIN_SYNC_TIME; 

if ((engine status ! = ENGINE SYNC MOOE) || (sync maintain timer » 0)) 

sync_on_timer = 0; 
sync_of f_timer ■ 0; 
sync"f irstjMSS = TRUE; 

sync~first_pass_timer = SYNCJMRST^PASS^TIME; 

if ((shift_type == UPSHIFT) U (shif t_ini t_type == AUTO) ) 

sync_offset » sync_of f set_neg; 
else 

sync_offset = syncj>ffset_pos; 

if (engine status != ENGINE SYNC MOOE) /* first time through sync V 

engine_status -= ENG I NE_SYNC_M00E ; 

if (forced_predip « FALSE) 
sync maintain timer « MAINTAIN SYNC TIME; 

> 

else /* sync maintain timer reached 0 */ 

C 

engine control = OVERRIDE DISABLED; 
command ETC1 - C ETC1 NORMAL; 

> 



else 
C 

syncjna i n t a i n_t i mer - - ; 

if (sync on timer** o 200) /* allow sync mode for about 2 seconds */ 
i 

sync^off^timer » 0; 

engine control » SPEED CONTROL; 

command_ETCT * C_ETC1_6vERSPEED; 

if (sync first_pass « TRUE) 
i 

if ((shift type » UPSHIFT) && (shift init type == AUTO)) 
( 

sync speed modified » (signed int)( input speed) ♦ 

(input_speed_accel~filtered /(1000/ENG_RESPONSE_UP$HF_TIME)); 

if (sync speed modified < gos signed) 
t 

if (sync first_pass timer 0) 
< 

sync_offset » sync_offset_pos; 
sync"f irst^pass ■ FALSE; 

) 

else 



sync first _pasa_tf 

> 

> 

else /* shift is a downshift V 

sync_speedjnodf f ied ■ (signed int)(input_speed) ♦ 

(input_speed_accel~f iltered /( 1000/ ENGJIE SPOUSE JMSHFJIKE)); 

if (sync speed modified > gos signed) 
C 

/* if (sync first_pass timer ==0) V 
/* i ' V 

sync first_pass = FALSE; 

if <(pct_demand_at_cur_sp < 15) || (shif t_init_type « MANUAL)) 
sync offset * sync offset neg; 
/* ) */ 
/* else */ 
/* sync first_pass timer--; */ 
> 



if (gos_signed ♦ sync_offset > 0) 

desired_engine_speed = (int)(gos_signed ♦ sync_offset); 
else 

desired_engine_speed = 0; 

> 

else 
C 

if (sync_of f_timer <= 4) 
sync_off_t imer++; 

else 
t 

sync_on_t imer = 0; 



if (shift_init_type == AUTO) 
sync_offset = -(sync_of f set); 



/* force sync speed to toggle around gos */ 



else 
{ 

sync first_pass = TRUE; 

sync~first_pass_timer = SYNC_FIRST_PASSJ'IME; 
sync_offset = sync_of fsetjaos; 

manual sync delayed_t imer = 0; /* used in SEQ_SHFT.C96 module V 

) 



#pragma EJECT 



* Ftretlon: control_engirwsync_tmjoodt (AutoSplit) 

* Description: 

* This function test the synchronize node of engine speed control. 



***************************** 



static void control engine sync_test aode(void) 

if (accelerator_pedal_position < 10) 
< 

engine_status = ENGINE_FOLLOUER_MOOE; 
engine~conroands = ENGINE FOLLOWER; 
engine'control * OVERRIDE DISABLED; 
conwand_ETC1 » C_ETC1_MOftMAL; 
desired~engine speed * 0; 

> 

else 

t 

if (accelerator_pedal_position > 90) 
< 

engine status » ENGINE SYNCJWE; 

engine_coamands * ENGINE_SYNC; 

engine'control ' SPEED CONTROL; 

command_ETC1 = C_ETC 1_QVER SPEED; 

desired~engine_speed = des ired_engine_s peed_ test ; 

desi red'engine's peed_ timer » desired engine's peed time; 

) 

else 
< 

if (desired_engine_speed_tiraer > 0) 

des i r ed_eng i ne_speed_t i mer • - ; 
else 
C 

if (desired engine speed > 600) 

t 

des i red_eng i ne_speed_t i mer a des i red_eng i ne_speed_t i roe; 
desired~engine~speed~» (desired engine speed - desired engine speed rasp) 

> 

> 

> 

> 

#pragma EJECT 



* F met ion: deter«ine_i f_recovery_conptete 

* Description: 

* This routine checks to see if the percent_torque_value_l imit has 

* exceeded the percent_torque_vslue feedback from the engine by xX 

* for x Billiseconds and will then set percent_torque_value_limit 

* to 100X to cancel the recovery node. 

********************** AT*************************************************/ 

static void determine if recovery complete(void) 
C 

if ((net engine jxt trq > 10) U 

(desired engine_pct trq > (net engine _pct trq ♦ RECOVERY CANCEL OFFSET))) 

i 

-M> recovery cancel timer; 

> 

else 

recovery_cancel_timer = 0; 

if ( (recovery_cancel_timer >« RECOVERY_CANCEL_TIMS) || 
(desired engine jxt trq « 100) ) 

< 

/* terminate the recovery mode */ 

desired engine _pct trq » 100; 

engine status = ENGINE RECOVERY M00E COMPLETE; 

> 

> 

fpragma EJECT 



* taction: cont ro I _eng i ne_r ecovery_nor»a I 

* Description: 

* Determine throttle command for recovery node. 

* TOftQLC_L!MIT is scaled as a B1M 8 nutter representing the percentage 

* of torque allowed to the engine during recovery. 

*********** ***/ 

static void control engine recovery normal (void) 
< 

engine_control * SPEED TQRQUEJJMIT; 
cc«mand_ETC1 * C_ETC1_NQRMAl; 

desired_engine_speed = 8031; /* torque limit only, max value for speed */ 
torquejimit RECOVER Y_RAT E_T A8L E [des t i na t i on_gear*4 ] ; /* BIN 8 V 
desired_engine jxt^trq » ( char )<torque_li rait » 8); /* BIM 0 */ 
determine if recovery completeO; 

> 

#pragma EJECT 
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